|
|
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) |