You cannot select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

59 lines
1.7 KiB
Matlab

clear all
close all
clc
data=importdata('input_canshu.txt');
%%%%<25><><EFBFBD><EFBFBD><EFBFBD>ֱ<EFBFBD><D6B1><EFBFBD>/m
GSD=data.data(3)/data.data(2)*data.data(1);
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%ƽ<>涨λ<E6B6A8><CEBB><EFBFBD>ȼ<EFBFBD><C8BC><EFBFBD>%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%GNSS<53><53><EFBFBD><EFBFBD>ȶԶ<C8B6>λ<EFBFBD><CEBB><EFBFBD>ȵ<EFBFBD>Ӱ<EFBFBD><D3B0>
GPS_X=sqrt((tan(data.data(5)*pi/180)*data.data(8))^2+data.data(8)^2);
GPS_Y=sqrt((tan(data.data(6)*pi/180)/cos(data.data(5)*pi/180)*data.data(8))^2+data.data(8)^2);
GPS_ALL=sqrt(GPS_X^2+GPS_Y^2);
%%<25><>̬ȷ<CCAC><C8B7><EFBFBD><EFBFBD><EFBFBD>ȶԶ<C8B6>λ<EFBFBD><CEBB><EFBFBD>ȵ<EFBFBD>Ӱ<EFBFBD><D3B0>
ZT_T=sqrt(data.data(9)^2+data.data(10)^2+data.data(11)^2+data.data(12)^2+data.data(13)^2);
ZT_X=data.data(1)*1000/(cos(data.data(5)*pi/180))^2*(ZT_T/3600*pi/180);
ZT_Y=data.data(1)*1000/(cos(data.data(5)*pi/180)*cos(data.data(6)*pi/180)^2)*(ZT_T/3600*pi/180);
ZT_ALL=sqrt(ZT_X^2+ZT_Y^2);
%%ʱ<><CAB1>ͬ<EFBFBD><CDAC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Զ<EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>Ӱ<EFBFBD><D3B0>
Time_X=data.data(14)*7/1000;
%%<25><>У<EFBFBD>в<EFBFBD><D0B2>Զ<EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>Ӱ<EFBFBD><D3B0>
Img_T=sqrt(data.data(15)^2+data.data(16)^2+data.data(17)^2+data.data(18)^2);
Img_X=GSD*Img_T/cos(data.data(5)*pi/180);
Img_Y=GSD*Img_T/cos(data.data(6)*pi/180);
Img_ALL=sqrt(Img_X^2+Img_Y^2);
PM_point=sqrt(GPS_ALL^2+ZT_ALL^2+Time_X^2+Img_ALL^2);
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%<25>̶߳<DFB3>λ<EFBFBD><CEBB><EFBFBD>ȼ<EFBFBD><C8BC><EFBFBD>%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%ƥ<><C6A5><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ͱ궨<CDB1>в<EFBFBD><D0B2>Ը߳̾<DFB3><CCBE>ȵ<EFBFBD>Ӱ<EFBFBD><D3B0>
PP_ALL=(1/data.data(4))*(GSD*Img_T/cos(data.data(5)*pi/180));
%%<25><>Ԫ<EFBFBD>ضԸ߳̾<DFB3><CCBE>ȵ<EFBFBD>Ӱ<EFBFBD><D3B0>
XYS_ALL=sqrt(0.5*data.data(8)^2+2*(1/data.data(4))^2*(data.data(8)^2+(data.data(14)*7/1000)^2));
%%<25><>Ԫ<EFBFBD>ضԸ߳̾<DFB3><CCBE>ȵ<EFBFBD>Ӱ<EFBFBD><D3B0>
JYS_ALL=sqrt(2)*(1/data.data(4))*ZT_X;
DEM=sqrt(PP_ALL^2+XYS_ALL^2+JYS_ALL^2);
str1='ƽ<EFBFBD>涨λ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>/m<><6D>';
str2='<EFBFBD>̶߳<EFBFBD>λ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>/m<><6D>';
fid=fopen('output_result.txt','w','n','UTF-8');
fprintf(fid,'%s\n',str1);
fprintf(fid,'%f\n',PM_point);
fprintf(fid,'%s\n',str2);
fprintf(fid,'%f\n',DEM);
exit(0)