摄影测量学 单向空间后方交会 c++

本程序是武汉大学著名教材摄影测量学下课后题中的单向空间后方交会程序 已完成 下载即可用

// hou fang jiao hui.cpp : Defines the entry point for the console application.
//
#include “stdafx.h“
#include 
#include
#include
#include “vector“
#include 
#define N 20
using namespace std;
using namespace cv;
#define PI 3.14159265358

void Inverse（double ATA[N][N]double ATA1[N][N]int n）
	 {
	     int i j k;
    double max temp;
    double t[99][99];                //临时矩阵	
    //将A矩阵存放在临时矩阵t[n][n]中
    for （i = 0; i < n; i++）        
    {
        for （j = 0; j < n; j++）
        {
            t[i][j] = ATA[i][j];
        }
    }
    //初始化B矩阵为单位阵
    for （i = 0; i < n; i++）        
    {
        for （j = 0; j < n; j++）
        {
            ATA1[i][j] = （i == j） ? （float）1 : 0;
        }
    }
    for （i = 0; i < n; i++）
    {
        //寻找主元
        max = t[i][i];
        k = i;
        for （j = i+1; j < n; j++）
        {
            if （fabs（t[j][i]） > fabs（max））
            {
                max = t[j][i];
                k = j;
            }
        }
        //如果主元所在行不是第i行，进行行交换
        if （k != i）
        {
            for （j = 0; j < n; j++）
            {
                temp = t[i][j];
                t[i][j] = t[k][j];
                t[k][j] = temp;
                //B伴随交换
                temp = ATA1[i][j];
                ATA1[i][j] = ATA1[k][j];
                ATA1[k][j] = temp; 
            }
        }
        temp = t[i][i];
        for （j = 0; j < n; j++）
        {
            t[i][j] = t[i][j] / temp;        //主对角线上的元素变为1
            ATA1[i][j] = ATA1[i][j] / temp;        //伴随计算
        }
        for （j = 0; j < n; j++）        //第0行->第n行
        {
            if （j != i）                //不是第i行
            {
                temp = t[j][i];
                for （k = 0; k < n; k++）        //第j行元素 - i行元素*j列i行元素
                {
                    t[j][k] = t[j][k] - t[i][k]*temp;
                    ATA1[j][k] = ATA1[j][k] - ATA1[i][k]*temp;
                }
            }
        }
    }
 }

void Multiply（double a[N][N] double b[N][N] double c[N][N] int a_row int a_column int b_rowint b_column）
{
	if（a_column==b_row）
	{
		for（int i=0;i		{
			
			for（int l=0;l			{	
				double k=0.0;  //函数不能拿过来就用，一定要根据程序的需要改变，k的值应该是double类型不能为int类型
				for（int j=0;j				{
					k=k+a[i][j]*b[j][l];				
				}
				c[i][l]=k;
			}
		}
	}
	else cout<<“您输入的矩阵有误请重新输入……\n\n“;
	//cout<<“***********矩阵相乘输出结果*********“<	//print（ca_rowb_column）;
}

int main（int argc char* argv[]）
{
	int count = 0; 
	int n = 4;

	double X1 = 36589.41;          
	double X2 = 37631.08;          
	double X3 = 39100.97;          
	double X4 = 40426.54;          

	double Y1 = 25273.32;          
	double Y2 = 31324.51;          
	double Y3 = 24934.98;          
	double Y4 = 30319.81;          
	 											

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----

     文件      51200  2015-11-11 21:49  hou fang jiao hui\Debug\hou fang jiao hui.exe

     文件     420360  2015-11-11 21:49  hou fang jiao hui\Debug\hou fang jiao hui.ilk

     文件    1526784  2015-11-11 21:49  hou fang jiao hui\Debug\hou fang jiao hui.pdb

     文件       2392  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\cl.command.1.tlog

     文件      18574  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\CL.read.1.tlog

     文件       1802  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\CL.write.1.tlog

     文件       2585  2015-11-11 21:36  hou fang jiao hui\hou fang jiao hui\Debug\hou fang jiao hui.Build.CppClean.log

     文件        406  2015-11-11 21:36  hou fang jiao hui\hou fang jiao hui\Debug\hou fang jiao hui.exe.embed.manifest

     文件        472  2015-11-11 21:36  hou fang jiao hui\hou fang jiao hui\Debug\hou fang jiao hui.exe.embed.manifest.res

     文件        381  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\hou fang jiao hui.exe.intermediate.manifest

     文件         63  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\hou fang jiao hui.lastbuildstate

     文件       3246  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\hou fang jiao hui.log

     文件     144574  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\hou fang jiao hui.obj

     文件    1179648  2015-11-11 21:36  hou fang jiao hui\hou fang jiao hui\Debug\hou fang jiao hui.pch

     文件          0  2015-11-11 21:36  hou fang jiao hui\hou fang jiao hui\Debug\hou fang jiao hui.write.1.tlog

     文件        224  2015-11-11 21:36  hou fang jiao hui\hou fang jiao hui\Debug\hou fang jiao hui_manifest.rc

     文件       1971  2015-11-11 21:36  hou fang jiao hui\hou fang jiao hui\Debug\hou.obj

     文件          2  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\link-cvtres.read.1.tlog

     文件          2  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\link-cvtres.write.1.tlog

     文件          2  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\link.8612-cvtres.read.1.tlog

     文件          2  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\link.8612-cvtres.write.1.tlog

     文件          2  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\link.8612.read.1.tlog

     文件          2  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\link.8612.write.1.tlog

     文件       3650  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\link.command.1.tlog

     文件       8302  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\link.read.1.tlog

     文件       1186  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\link.write.1.tlog

     文件        466  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\mt.command.1.tlog

     文件        394  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\mt.read.1.tlog

     文件        394  2015-11-11 21:49  hou fang jiao hui\hou fang jiao hui\Debug\mt.write.1.tlog

     文件        668  2015-11-11 21:36  hou fang jiao hui\hou fang jiao hui\Debug\rc.command.1.tlog

............此处省略43个文件信息