www.gusucode.com > GPS仿真Matlab编程源码程序 > GPS仿真Matlab编程源码程序/jingweiduqiujuli.m
clear clc a1=40+0/3600;%假定用户位置纬度 a2=120+0/3600;%假定用户位置经度 % a3=44.923;%无干扰解算纬度 % a4=40.431;%无干扰解算经度 a5=40+(60-59.852254)/3600;%有干扰解算纬度 a6=120+(60-59.707456)/3600;%有干扰解算经度 x1=cos(a1)*cos(a2); y1=cos(a1)*sin(a2); z1=sin(a1); x2=cos(a5)*cos(a6); y2=cos(a5)*sin(a6); z2=sin(a5); % x3=cos(a3)*cos(a4); % y3=cos(a3)*sin(a4); % z3=sin(a3); do1=sqrt(x1^2+y1^2+z1^2); do2=sqrt(x2^2+y2^2+z2^2); d12=sqrt((x2-x1)^2+(y2-y1)^2+(z2-z1)^2); phi=acos((do1^2+do2^2-d12^2)/(2*do1*do2)); s=6371e3*phi/180*3.1415926 A=acos(x1*x2+y1*y2+z1*z2); s1=A/180*pi*6371e3 % B=acos(x1*x3+y1*y3+z1*z3); % s2=B/180*pi*6371e3