摄影后方交会0215.docxVIP

摄影测量—空间后方交会 矿业工程学院_10级GIS_215 1 - 摄影测量单像空间后方交会 10_GIS_2班 已知摄影机主距f=153.24mm，四对点的像点坐标与相应的地面坐标列入下表： 点号 像点坐标 地面坐标 x(mm) y(mm) x(m) y(m) z(m) 1 -86.15 -68.99 36589.41 25273.32 2195.17 2 -53.40 82.21 37631.08 31324.51 728.69 3 -14.78 -76.63 39100.97 24934.98 2386.50 4 10.46 64.43 40426.54 30319.81 757.31 求六个方位元素及其中误差 运用C++编写程序，具体步骤如下图： 首先将原始数据存储到.txt文本下，供后期编程过程中调用 程序代码如下： // 空间后方交会.cpp : Defines the entry point for the console application. // #include <stdio.h> #include <stdlib.h> #include <windows.h> #include <math.h> #include <iostream> #include<array> #include "mtxfunction.h" //矩阵求逆运算、转置、相乘 using namespace std; /*************************************** 声明结构类型GCP，用来保存控制点坐标 ***************************************/ struct GCP { double x; //影像控制点x坐标 double y; //影像控制点y坐标 double Xt; //地面控制点Xt坐标 double Yt; //地面控制点Yt坐标 double Zt; //地面控制点Zt坐标 }; /***************************************/ // 声明读取文本数据函数 int Inputdata(int &GCPN, GCP *data, double &m, double &f, double &x0, double &y0); /***************************************/ // int main() { system("title 单像空间后方交会"); //声明变量 int GCPN=100; //控制点对数GCPN double m =50000, f = 153.24, x0 = 0, y0 = 0; //比例尺m，主距f，外方位元素x0,y0 GCP data[4]; //控制点坐标矩阵 double Xs = 0, Ys = 0, Zs = 0, fai = 0, omiga = 0, k = 0; //内个外方位元素 double mtxX[6]; //X矩阵 X=[ΔXs,ΔYs,ΔZs,Δψ,Δω,Δκ] mtxX[3] = 1; double mtxR[9]; //旋转矩阵R double mtxresult1[6][6], mtxresult2[6]; //1保存ATA及其逆矩阵 和2保存ATL，相乘得到X结果 int i, n = 0; double sum = 0, m0; /***************************************/ // 读取数据 gotokaishi: ; //goto标记 if(Inputdata(GCPN, data, m, f, x0, y0)) { cout << "读取“原始数据.txt”出现错误！\n"; cout << "请将“原始数据.txt”置于程序所在目录中，并检查数据格式。"; cout << "\n数据格式如下所示\n(第一行为控制点个数和m，第二行为f,x0,y0，其余行为控制点坐标x,y,Xt,Yt,Zt)\n"; cout << "4\t0.0\n"; cout << "153.24\t0.0\t