clear all
close all
clc

data=importdata('input_canshu.txt');

%%%%成像分辨率/m
GSD=data.data(3)/data.data(2)*data.data(1);


%%%%%%%%%%%%%%%%%%%%%%%%%%%%%平面定位精度计算%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%GNSS定轨精度对定位精度的影响
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);

%%姿态确定精度对定位精度的影响
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);

%%时间同步误差对定位精度影响
Time_X=data.data(14)*7/1000;

%%标校残差对定位精度影响
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);



%%%%%%%%%%%%%%%%%%%%%%%%%%%%%高程定位精度计算%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%匹配误差和标定残差对高程精度的影响
PP_ALL=(1/data.data(4))*(GSD*Img_T/cos(data.data(5)*pi/180));

%%线元素对高程精度的影响
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));
%%角元素对高程精度的影响
JYS_ALL=sqrt(2)*(1/data.data(4))*ZT_X;


DEM=sqrt(PP_ALL^2+XYS_ALL^2+JYS_ALL^2);

str1='平面定位结果/m：';
str2='高程定位结果/m：';

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)