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