MATLAB计算卫星瞬时位置和瞬时速度

clc
clear
A=[ 244800            5153.65531        0.005912038265     0.984848407943
    1.038062244       -1.717457876      -1.064739758       4.249105564e-9
    7.422851197e-51   -8.151768125e-9   3.054738045e-7     2.237036824e-6
    350.53125         2.53125            -8.381903172e-8    8.940696716e-8];
t=239050.7223;
GM=3.986005e+14;
tk=t-A(1,1);                               %规划时间
while(tk>302400 || tk<-302400)
   if tk>302100
       tk=tk-604800;
   else
       tk=tk+604800;
   end
end
n0=sqrt(GM/(A(1,2)^6));
n=n0+A(2,4);                               %卫星平均角速度
Mk=A(2,3)+n*tk;                            %卫星平近点角
while(Mk<0 || Mk>2*pi)
  if Mk<0
    Mk=Mk+2*pi;
  else
    Mk=Mk-2*pi;
  end
end
Ek=Mk;
for i=1:3