cgmf0orig.f File Reference

Go to the source code of this file.

Functions/Subroutines
subroutine	mfgmf0 (bh, bv, w01, w02, w03, bt)

Function/Subroutine Documentation

mfgmf0()

subroutine mfgmf0	(		bh,
			bv,
			w01,
			w02,
			w03,
			bt
	)

Definition at line 88 of file cgmf0orig.f.

References b, dx, e, p, x, xs, y, and z.

c
      dimension tm(3,3)
      data small /1.e-3/
      save b, tm, cosa, sina
      real*8 dst
c
c          mag. of gmf
      b=sqrt(bh**2 + bv**2)
c          cos(alfa)
      cosa=(bh * w02  +  bv * w03)/b
      cosa2=cosa**2
      sina=sqrt(1. - cosa2)
      bt=b * sina
      sb2= w01**2 + (bh/b-w02)**2 + (bv/b-w03)**2
      if(sb2 .gt. small) then
          cota=cosa/sina
          tm(1,1)= ( bh*w03 - bv*w02 ) /bt
          tm(1,2)= -cota*w01
          tm(1,3)= w01
          tm(2,1)= bv*w01/bt
          tm(2,2)= bh/bt - cota*w02
          tm(2,3)= w02
          tm(3,1)= -bh*w01/bt
          tm(3,2)= bv/bt - cota*w03
          tm(3,3)= w03
      else
          tm(1,1)= 1.
          tm(1,2)= 0.
          tm(1,3)= 0.
          tm(2,1)= 0.
          tm(2,2)=bv/b
          tm(2,3)=bh/b
          tm(3,1)=0.
          tm(3,2)= -bh/b
          tm(3,3)= bv/b
      endif
      return
c
c
c     ************
      entry mfgeom(p, iz, dst, w1i, w2i, w3i, dx, dy, tx, ty)
c     ************
c
      if(iz .eq. 0) then
         dx=0
         dy=0
         tx=0
         ty=0
      else
         z=iz
         wt=z*b*dst*3.e-10/p
         wt2=wt**2/2
         ak=wt*dst/2
c
         dx=  (cosa*w2i - sina*w3i) *ak
         dy= - ak*cosa*w1i
c
c        tx=  (cosa*w2i - sina*w3i) *wt - wt2 *w1i
         tx=  (cosa*w2i - sina*w3i) *wt
c        ty= -wt*cosa*w1i - (cosa2*w2i - sina2*w3i)*wt2
         ty= -wt*cosa*w1i
c        tz= sina*wt*w1i + (csa *w2i - sina2*w3i)*wt2
         tz= sina*wt*w1i
      endif
      return
c
c       convert (x,y,z) in 1ry system into * system
c     ************
      entry mfptos(x, y, z, xs, ys, zs)
c     ************
c
      tmp1= tm(1,1)*x + tm(1,2)*y + tm(1,3)*z
      tmp2= tm(2,1)*x + tm(2,2)*y + tm(2,3)*z
      zs  = tm(3,1)*x + tm(3,2)*y + tm(3,3)*z
      xs  = tmp1
      ys  = tmp2
      return
c
c       convert (x,y,z) in * system into  1ry system
c     ************
      entry mfstop(xs, ys, zs, x, y, z)
c     ************
c
      tmp1= tm(1,1)*xs + tm(2,1)*ys + tm(3,1)*zs
      tmp2= tm(1,2)*xs + tm(2,2)*ys + tm(3,2)*zs
      z  = tm(1,3)*xs + tm(2,3)*ys + tm(3,3)*zs
      x  = tmp1
      y  = tmp2