*-- Author : S.Burke / J.V. Morris
SUBROUTINE FKRPXY(SIN,CIN,SOUT,COUT)
**********************************************************************
* *
* Transform a state vector and covariance from (R,PHI) to (x,y) *
* *
* Both are assumed to be at fixed z. *
* *
* *** NOT TESTED *** *
* *
**********************************************************************
IMPLICIT DOUBLE PRECISION (A-H,O-Z)
DIMENSION SIN(5),CIN(5,5),SOUT(5),COUT(5,5)
**********************************************************************
CALL UCOPY(SIN(3),SOUT(3),6)
CALL UCOPY(CIN(3,3),COUT(3,3),26)
CPHI = COS(SIN(2))
C2PHI = CPHI*CPHI
S2PHI = 1.D0 - C2PHI
SPHI = SQRT(S2PHI)
CSPHI = CPHI*SPHI
R = SIN(1)
R2 = R*R
X = R*CPHI
Y = R*SPHI
SOUT(1) = X
SOUT(2) = Y
CRR = CIN(1,1)
CRP = CIN(2,1)
CPP = CIN(2,2)
COUT(1,1) = C2PHI*CRR - 2.D0*Y*CPHI*CRP + Y*Y*CPP
COUT(2,1) = CSPHI*CRR + (C2PHI - S2PHI)*R*CRP - X*Y*CPP
COUT(3,1) = CPHI*CIN(3,1) - Y*CIN(3,2)
COUT(4,1) = CPHI*CIN(4,1) - Y*CIN(4,2)
COUT(5,1) = CPHI*CIN(5,1) - Y*CIN(5,2)
COUT(2,2) = S2PHI*CRR + 2.D0*X*SPHI*CRP + X*X*CPP
COUT(3,2) = SPHI*CIN(3,1) + X*CIN(3,2)
COUT(4,2) = SPHI*CIN(4,1) + X*CIN(4,2)
COUT(5,2) = SPHI*CIN(5,1) + X*CIN(5,2)
RETURN
END
*