📄 backwardsection_xiayudlg.cpp

📁 本程序为近景摄影测量的单像空间后方交会算法,采用VC++实现
💻 CPP
📖 第 1 页 / 共 2 页
字号:
12 下一页
//文件名： BackWardSection_XiaYuDlg.cpp 
//创建人：夏宇
//创建时间：2004.10.15
// BackWardSection_XiaYuDlg.cpp : implementation file
//

#include "stdafx.h"
#include "BackWardSection_XiaYu.h"
#include "BackWardSection_XiaYuDlg.h"

#ifdef _DEBUG
#define new DEBUG_NEW
#undef THIS_FILE
static char THIS_FILE[] = __FILE__;
#endif
#include "EditDlg.h"
/////////////////////////////////////////////////////////////////////////////
// CAboutDlg dialog used for App About
#include "math.h"

#define X 0 
#define Y 1
#define Z 2
#define FAI 3
#define OMIGA 4
#define KAMA 5
#define PI 3.1415926535897932

//控制点地面坐标结构体
typedef struct tagPOINTGROUND
{
	double dfX; //地面坐标X
	double dfY; //地面坐标Y
	double dfZ; //地面坐标Z
}POINTGROUND;

//控制点影像坐标结构体
typedef struct tagPOINTIMG
{
	double dfX; //影像坐标x
	double dfY; //影像坐标y
}POINTIMG;

//控制点结构体
typedef struct tagGCP
{
	POINTGROUND ptGroundCoor; //控制点地面坐标
	POINTIMG ptImgCoor; //控制点影像坐标
}GCP;

class CAboutDlg : public CDialog
{
public:
	CAboutDlg();

// Dialog Data
	//{{AFX_DATA(CAboutDlg)
	enum { IDD = IDD_ABOUTBOX };
	//}}AFX_DATA

	// ClassWizard generated virtual function overrides
	//{{AFX_VIRTUAL(CAboutDlg)
	protected:
	virtual void DoDataExchange(CDataExchange* pDX);    // DDX/DDV support
	//}}AFX_VIRTUAL

// Implementation
protected:
	//{{AFX_MSG(CAboutDlg)
	//}}AFX_MSG
	DECLARE_MESSAGE_MAP()
};

CAboutDlg::CAboutDlg() : CDialog(CAboutDlg::IDD)
{
	//{{AFX_DATA_INIT(CAboutDlg)
	//}}AFX_DATA_INIT
}

void CAboutDlg::DoDataExchange(CDataExchange* pDX)
{
	CDialog::DoDataExchange(pDX);
	//{{AFX_DATA_MAP(CAboutDlg)
	//}}AFX_DATA_MAP
}

BEGIN_MESSAGE_MAP(CAboutDlg, CDialog)
	//{{AFX_MSG_MAP(CAboutDlg)
		// No message handlers
	//}}AFX_MSG_MAP
END_MESSAGE_MAP()

/////////////////////////////////////////////////////////////////////////////
// CBackWardSection_XiaYuDlg dialog

CBackWardSection_XiaYuDlg::CBackWardSection_XiaYuDlg(CWnd* pParent /*=NULL*/)
	: CDialog(CBackWardSection_XiaYuDlg::IDD, pParent)
{
	//{{AFX_DATA_INIT(CBackWardSection_XiaYuDlg)
	m_dffk = 153.24;
	m_dfx0 = 0.0;
	m_dfy0 = 0.0;
	m_strPathName = _T("C:\\Result2.txt");
	//}}AFX_DATA_INIT
	// Note that LoadIcon does not require a subsequent DestroyIcon in Win32
	m_hIcon = AfxGetApp()->LoadIcon(IDR_MAINFRAME);
}

void CBackWardSection_XiaYuDlg::DoDataExchange(CDataExchange* pDX)
{
	CDialog::DoDataExchange(pDX);
	//{{AFX_DATA_MAP(CBackWardSection_XiaYuDlg)
	DDX_Control(pDX, IDC_LISTGCP, m_ListGcp);
	DDX_Text(pDX, IDC_FK, m_dffk);
	DDX_Text(pDX, IDC_X0, m_dfx0);
	DDX_Text(pDX, IDC_Y0, m_dfy0);
	DDX_Text(pDX, IDC_PATH, m_strPathName);
	//}}AFX_DATA_MAP
}

BEGIN_MESSAGE_MAP(CBackWardSection_XiaYuDlg, CDialog)
	//{{AFX_MSG_MAP(CBackWardSection_XiaYuDlg)
	ON_WM_SYSCOMMAND()
	ON_WM_PAINT()
	ON_WM_QUERYDRAGICON()
	ON_NOTIFY(NM_CLICK, IDC_LISTGCP, OnClickListgcp)
	ON_NOTIFY(LVN_BEGINLABELEDIT, IDC_LISTGCP, OnBeginlabeleditListgcp)
	ON_BN_CLICKED(IDC_ACTION, OnAction)
	//}}AFX_MSG_MAP
END_MESSAGE_MAP()

/////////////////////////////////////////////////////////////////////////////
// CBackWardSection_XiaYuDlg message handlers

BOOL CBackWardSection_XiaYuDlg::OnInitDialog()
{
	CDialog::OnInitDialog();

	// Add "About..." menu item to system menu.

	// IDM_ABOUTBOX must be in the system command range.
	ASSERT((IDM_ABOUTBOX & 0xFFF0) == IDM_ABOUTBOX);
	ASSERT(IDM_ABOUTBOX < 0xF000);

	CMenu* pSysMenu = GetSystemMenu(FALSE);
	if (pSysMenu != NULL)
	{
		CString strAboutMenu;
		strAboutMenu.LoadString(IDS_ABOUTBOX);
		if (!strAboutMenu.IsEmpty())
		{
			pSysMenu->AppendMenu(MF_SEPARATOR);
			pSysMenu->AppendMenu(MF_STRING, IDM_ABOUTBOX, strAboutMenu);
		}
	}

	// Set the icon for this dialog.  The framework does this automatically
	//  when the application's main window is not a dialog
	SetIcon(m_hIcon, TRUE);			// Set big icon
	SetIcon(m_hIcon, FALSE);		// Set small icon
	
	// TODO: Add extra initialization here

	m_ListGcp.InsertColumn(0,"ID",LVCFMT_LEFT,60,-1); //控制点编号

	m_ListGcp.InsertColumn(1,"X",LVCFMT_LEFT,100,-1); //控制点地面坐标X

	m_ListGcp.InsertColumn(2,"Y",LVCFMT_LEFT,100,-1); //控制点地面坐标Y

	m_ListGcp.InsertColumn(3,"Z",LVCFMT_LEFT,100,-1); //控制点地面坐标Z

	m_ListGcp.InsertColumn(4,"x",LVCFMT_LEFT,100,-1); //控制点影像坐标x

	m_ListGcp.InsertColumn(5,"y",LVCFMT_LEFT,100,-1); //控制点影像坐标y

//	m_ListGcp.SetExtendedStyle(LVS_EX_FULLROWSELECT | LVS_EX_GRIDLINES|LVS_EX_CHECKBOXES); //设置列表属性
	m_ListGcp.SetExtendedStyle(LVS_EX_FULLROWSELECT | LVS_EX_GRIDLINES); //设置列表属性

	m_ListGcp.InsertItem(0,""); //插入控制点记录

	m_ListGcp.SetItem(0,0,LVIF_TEXT,"1",0,LVIF_STATE,0,0); //设置控制点编号

	m_ListGcp.SetItem(0,1,LVIF_TEXT,"36589.410000",0,LVIF_STATE,0,0); //设置控制点地面坐标X

	m_ListGcp.SetItem(0,2,LVIF_TEXT,"25273.320000",0,LVIF_STATE,0,0); //设置控制点地面坐标Y

	m_ListGcp.SetItem(0,3,LVIF_TEXT,"2195.170000",0,LVIF_STATE,0,0);  //设置控制点地面坐标Z

	m_ListGcp.SetItem(0,4,LVIF_TEXT,"-86.150000",0,LVIF_STATE,0,0); //设置控制点影像坐标x

	m_ListGcp.SetItem(0,5,LVIF_TEXT,"-68.990000",0,LVIF_STATE,0,0);  //设置控制点影像坐标y

	m_ListGcp.InsertItem(1,"");//插入控制点记录

	m_ListGcp.SetItem(1,0,LVIF_TEXT,"2",0,LVIF_STATE,0,0); //设置控制点编号

	m_ListGcp.SetItem(1,1,LVIF_TEXT,"37631.080000",0,LVIF_STATE,0,0); //设置控制点地面坐标X


	m_ListGcp.SetItem(1,2,LVIF_TEXT,"31324.510000",0,LVIF_STATE,0,0);//设置控制点地面坐标Y

	m_ListGcp.SetItem(1,3,LVIF_TEXT,"728.690000",0,LVIF_STATE,0,0);  //设置控制点地面坐标Z

	m_ListGcp.SetItem(1,4,LVIF_TEXT,"-53.400000",0,LVIF_STATE,0,0); //设置控制点影像坐标x

	m_ListGcp.SetItem(1,5,LVIF_TEXT,"82.210000",0,LVIF_STATE,0,0); //设置控制点影像坐标y

	m_ListGcp.InsertItem(2,"");//插入控制点记录

	m_ListGcp.SetItem(2,0,LVIF_TEXT,"3",0,LVIF_STATE,0,0); //设置控制点编号

	m_ListGcp.SetItem(2,1,LVIF_TEXT,"39100.970000",0,LVIF_STATE,0,0); //设置控制点地面坐标X

	m_ListGcp.SetItem(2,2,LVIF_TEXT,"24934.980000",0,LVIF_STATE,0,0); //设置控制点地面坐标Y

	m_ListGcp.SetItem(2,3,LVIF_TEXT,"2386.500000",0,LVIF_STATE,0,0); //设置控制点地面坐标Z

	m_ListGcp.SetItem(2,4,LVIF_TEXT,"-14.780000",0,LVIF_STATE,0,0); //设置控制点影像坐标x

	m_ListGcp.SetItem(2,5,LVIF_TEXT,"-76.630000",0,LVIF_STATE,0,0); //设置控制点影像坐标y


	m_ListGcp.InsertItem(3,"");//插入控制点记录

	m_ListGcp.SetItem(3,0,LVIF_TEXT,"4",0,LVIF_STATE,0,0); //设置控制点编号

	m_ListGcp.SetItem(3,1,LVIF_TEXT,"40426.540000",0,LVIF_STATE,0,0);//设置控制点地面坐标X
	
	m_ListGcp.SetItem(3,2,LVIF_TEXT,"30319.810000",0,LVIF_STATE,0,0); //设置控制点地面坐标Y

	m_ListGcp.SetItem(3,3,LVIF_TEXT,"757.310000",0,LVIF_STATE,0,0); //设置控制点地面坐标Z

	m_ListGcp.SetItem(3,4,LVIF_TEXT,"10.460000",0,LVIF_STATE,0,0); //设置控制点影像坐标x

	m_ListGcp.SetItem(3,5,LVIF_TEXT,"64.430000",0,LVIF_STATE,0,0); //设置控制点影像坐标y

	return TRUE;  // return TRUE  unless you set the focus to a control
}

void CBackWardSection_XiaYuDlg::OnSysCommand(UINT nID, LPARAM lParam)
{
	if ((nID & 0xFFF0) == IDM_ABOUTBOX)
	{
		CAboutDlg dlgAbout;
		dlgAbout.DoModal();
	}
	else
	{
		CDialog::OnSysCommand(nID, lParam);
	}
}

// If you add a minimize button to your dialog, you will need the code below
//  to draw the icon.  For MFC applications using the document/view model,
//  this is automatically done for you by the framework.

void CBackWardSection_XiaYuDlg::OnPaint() 
{
	if (IsIconic())
	{
		CPaintDC dc(this); // device context for painting

		SendMessage(WM_ICONERASEBKGND, (WPARAM) dc.GetSafeHdc(), 0);

		// Center icon in client rectangle
		int cxIcon = GetSystemMetrics(SM_CXICON);
		int cyIcon = GetSystemMetrics(SM_CYICON);
		CRect rect;
		GetClientRect(&rect);
		int x = (rect.Width() - cxIcon + 1) / 2;
		int y = (rect.Height() - cyIcon + 1) / 2;

		// Draw the icon
		dc.DrawIcon(x, y, m_hIcon);
	}
	else
	{
		CDialog::OnPaint();
	}
}

// The system calls this to obtain the cursor to display while the user drags
//  the minimized window.
HCURSOR CBackWardSection_XiaYuDlg::OnQueryDragIcon()
{
	return (HCURSOR) m_hIcon;
}

void CBackWardSection_XiaYuDlg::OnOK() 
{
	UpdateData();

    //处理过程置为等待状态
    CWaitCursor wait;

	//获取已知值
	double dffk = m_dffk/1000; //内方位元素：摄相机主距
	double dfx0 = 0.0; //内方位元素：像主点x0坐标
	double dfy0 = 0.0; //内方位元素：像主点y0坐标

	//地面控制点数
	int nCtrlPointNum = m_ListGcp.GetItemCount();

	//估算像片比例尺分母
	double dfDisStart = 0.0;
	double dfDisEnd = 0.0;

	double dfDis = 0.0;
	double dfMin = 0.0;

	CString strDisStart;

	CString strDisEnd;

	int nIndexStart = 0; //记录高程最相近的两控制点的编号 

	int nIndexEnd = 0; //记录高程最相近的两控制点的编号

	//找出高程最相近的两点
	for(int i=0;i<nCtrlPointNum-1;i++)
	{
        
		strDisStart = m_ListGcp.GetItemText(i,3);
		dfDisStart  = atof(strDisStart);//地面坐标Z

		for(int j=i+1;j<nCtrlPointNum;j++)
		{
			strDisEnd = m_ListGcp.GetItemText(i,3);
			dfDisEnd  = atof(strDisEnd);//地面坐标Z

			dfDis = pow(dfDisStart-dfDisEnd,2); //高差

			if(i==0 && j==1)
			{
				dfMin = dfDis;
				nIndexStart = i;
				nIndexEnd = j;
			}
			else
			{
				if(dfDis<dfMin)
				{
					dfMin = dfDis;

					nIndexStart = i;
					nIndexEnd = j;
				}
			}
		}
	}

	CString strDisX1 = m_ListGcp.GetItemText(nIndexStart,1);
	double dfDisX1  = atof(strDisX1);//地面坐标X

	CString strDisY1 = m_ListGcp.GetItemText(nIndexStart,2);
	double dfDisY1  = atof(strDisY1);//地面坐标Y

	CString strDisX2 = m_ListGcp.GetItemText(nIndexEnd,1);
	double dfDisX2 = atof(strDisX2);//地面坐标X

	CString strDisY2 = m_ListGcp.GetItemText(nIndexEnd,2);
	double dfDisY2  = atof(strDisY2);//地面坐标Y

	CString strDisx1 = m_ListGcp.GetItemText(nIndexStart,4);
	double dfDisx1  = atof(strDisx1);//影像坐标x

	CString strDisy1 = m_ListGcp.GetItemText(nIndexStart,5);
	double dfDisy1  = atof(strDisy1);//影像坐标y

	CString strDisx2 = m_ListGcp.GetItemText(nIndexEnd,4);
	double dfDisx2 = atof(strDisx2);//影像坐标x

	CString strDisy2 = m_ListGcp.GetItemText(nIndexEnd,5);
	double dfDisy2  = atof(strDisy2);//影像坐标y

	//估算出像片比例尺分母
	int m = sqrt(pow(dfDisX1-dfDisX2,2)+pow(dfDisY1-dfDisY2,2))/sqrt(pow(dfDisx1-dfDisx2,2)+pow(dfDisy1-dfDisy2,2))*1000;

	double dfH = m*dffk; //估算航高
    
	GCP *pGcp = new GCP[nCtrlPointNum];

	//控制点的影像坐标和地面坐标
	CString strValue;

	for(i=0;i<nCtrlPointNum;i++)
	{
		strValue = m_ListGcp.GetItemText(i,1);
		(pGcp+i)->ptGroundCoor.dfX  = atof(strValue);//地面坐标X

		strValue = m_ListGcp.GetItemText(i,2);
		(pGcp+i)->ptGroundCoor.dfY  = atof(strValue);//地面坐标Y

		strValue = m_ListGcp.GetItemText(i,3);
		(pGcp+i)->ptGroundCoor.dfZ = atof(strValue);//地面坐标Z

		strValue = m_ListGcp.GetItemText(i,4);//影像坐标x
		(pGcp+i)->ptImgCoor.dfX = atof(strValue)/1000;

		strValue = m_ListGcp.GetItemText(i,5);//影像坐标y
		(pGcp+i)->ptImgCoor.dfY = atof(strValue)/1000;
	}


	//初始化外方位元素
	double *pdfElement = new double[6];

    pdfElement[X] = 0;	//摄影中心XS

    pdfElement[Y] = 0;	//摄影中心YS

    pdfElement[Z] = 0;	//摄影中心ZS

	for( i=0;i<nCtrlPointNum;i++)
	{
		pdfElement[X] += (pGcp+i)->ptGroundCoor.dfX;
	}

	pdfElement[X] /=nCtrlPointNum; //初始值设为控制点地面坐标X平均值

	for(i=0;i<nCtrlPointNum;i++)
	{
		pdfElement[Y] += (pGcp+i)->ptGroundCoor.dfY;
	}

	pdfElement[Y] /=nCtrlPointNum;//初始值设为控制点地面坐标Y平均值


	//	for(i=0;i<nCtrlPointNum;i++)
	//	{
	//		pdfElement[Z] += (pGcp+i)->ptGroundCoor.dfZ;
	//	}
	//	pdfElement[Z] /=nCtrlPointNum;

    //pdfElement[Z] += dfH; //初始值设为控制点地面坐标Z平均值+航高

    pdfElement[Z] = dfH; //初始值设为航高
	
    pdfElement[FAI] = 0.0;  //外方位角元素 fai 初始值设为0

    pdfElement[OMIGA] = 0.0; //外方位角元素 omiga 初始值设为0

    pdfElement[KAMA] = 0.0; //外方位角元素 kama 初始值设为0

	int nDiedaiNum = 0; //迭代次数初始化为0

	double *pdfR = new double[9]; //旋转矩阵
 
	double *pdfa = new double[nCtrlPointNum*12]; //误差方程式系数矩阵
   
	double *pdfL = new double[2*nCtrlPointNum];//误差方程式常数项

	double *pdfaT = new double[nCtrlPointNum*12];//误差方程式系数矩阵的转置阵

	double pdfaMutaT[6*6]; //误差方程式系数矩阵与其转置阵的乘积阵

	double *pdfBridge = new double[6*2*nCtrlPointNum];  //中间变量

	double Result[6*1];//中间变量

    CStdioFile file; //输出解算过程及结果到文件中

	if(!file.Open(m_strPathName,CFile::modeCreate|CFile::modeReadWrite))
	{
		AfxMessageBox("创建或写文件失败!");
		return;
	}

	//单像空间后方交会算法主体部分

    BOOL bRight = FALSE; //标识程序是否正常结束
12 下一页
💿 文件大小 39 K
👤 上传用户 linux_open_lab
📂 所属分类数值算法/人工智能
🏷️ 相关标签

#VC #程序 #摄影测量 #近景
⌨️ 快捷键说明

复制代码 Ctrl + C
搜索代码 Ctrl + F
全屏模式 F11
切换主题 Ctrl + Shift + D
显示快捷键 ?
增大字号 Ctrl + =
减小字号 Ctrl + -