运用matlab计算gps卫星的坐标位置

clearclcformatlongtp=input('tp=');toc=input('toc=');a0=input('a0=');a1=input('a1=');a2=input('a2=');toe=input('toe=');M0=input('M0=');a=input('³¤°ë¾¶a=');deltan=input('ÎÀÐÇƽ¾ù½ÇËÙ¶ÈÖ®²îdeltan=');e=input('e=');w=input('w=');Cuc=input('Cuc=');Cus=input('Cus=');Cic=input('Cic=');Cis=input('Cis=');Crc=input('Crc=');Crs=input('Crs=');i0=input('i0=');I=input('¹ìµÀÇã½Ç±ä»¯ÂÊI=');OM0=input('OM0=');OM=input('Éý½»µã³à¾¶±ä»¯ÂÊOM=');tt=a0+a1*(tp-toc)+a2*(tp-toc);t=tp-tt;tk=t-toe;u=3.986005e14;n0=(sqrt(u))/(a*a*a);n=n0+deltan;Mk=M0+n*tk;{n=MK;ek0=0;ek1=n+e*sin(ek0);ek2=n+e*sin(ek1);EK=ek2;}Dk=1;Ek=0;n1=0;whileabs(Ek-Dk)0.0000000001n1=n1+1;Ek=Dk;Dk=Mk+e*sin(Ek);endEk=Dk;Vk=atan((sqrt(1-e*e)*sin(Ek)/(cos(Ek)-e));ifsin(Ek)0&cos(Ek)-e0Vk=pi-Vk;elseifsin(Ek)0&cos(Ek)-e0Vk=pi+Vk;elseifsin(Ek)0&cos(Ek)-e0Vk=2*pi-Vk;endFaik=Vk+w;SigmaU=Cuc*cos(2*Faik)+Cus*sin(2*Faik);SigmaR=Crc*cos(2*Faik)+Crs*sin(2*Faik);SigmaI=Cic*cos(2*Faik)+Cis*sin(2*Faik);Uk=Faik+SigmaU;Rk=a*(1-e*cos(Ek))+SigmaR;Ik=i0+SigmaI+I*tk;X0=Rk*cos(Uk);Y0=Rk*sin(Uk);we=7.29211567e-5;OMK=OM0+(OM-we)*tk-we*toe;Xk=X0*cos(OMK)-Y0*cos(Ik)*sin(OMK);Yk=X0*sin(OMK)+Y0*cos(Ik)*cos(OMK);Zk=Y0*sin(Ik);disp(['ÎÀÐÇÖÓ²î¸ÄÕýdt=',num2str(tt)])disp(['¹é»¯Ê±¿Ìtk=',num2str(tk)])disp(['ƽ¾ùÔËÐнÇËÙ¶Èn=',num2str(n)])disp(['ÎÀÐÇƽ½üµã½ÇMk=',num2str(Mk)])disp(['Æ«½üµã½ÇEk=',num2str(Ek)])disp(['Õæ½üµã½ÇVk=',num2str(Vk)])disp(['Éý½»¾à½ÇFaik=',num2str(Faik)])disp(['É㶯¸ÄÕýÏîSigmaU=',num2str(SigmaU)])disp(['É㶯¸ÄÕýÏîSigmaR=',num2str(SigmaR)])disp(['É㶯¸ÄÕýÏîSigmaI=',num2str(SigmaI)])disp('¾­¹ýÉ㶯¸ÄÕýÏ')disp(['Éý½»¾à½ÇUk=',num2str(Uk)])disp(['ÎÀÐÇʸ¾¶Rk=',num2str(Rk)])disp(['¹ìµÀÇã½ÇIk=',num2str(Ik)])disp('ÎÀÐÇÔÚ¹ìµÀƽÃæ×ø±êϵµÄ×ø±ê')disp(['X0=',num2str(X0)])disp(['Y0=',num2str(Y0)])disp(['¹Û²âʱ¿ÌÉý½»µã¾­¶ÈOMK=',num2str(OMK)])disp('ÎÀÐÇÔÚµØÐĹ̶¨×ø±êϵÖеÄÖ±½Ç×ø±ê')disp(['Xk=',num2str(Xk)])disp(['Yk=',num2str(Yk)])disp(['Zk=',num2str(Zk)])