空间后方交会的VB代码

Option Explicit

Dim m#, H#                                                      '航摄比例尺、航高
Dim x0, y0, f                                                   '内方位元素
Dim Xt#(1 To 4), Yt#(1 To 4), Zt#(1 To 4)                       '控制点地面测量坐标（控制测量得到）
Dim Xtp#(1 To 4), Ytp#(1 To 4), Ztp#(1 To 4)                    '控制点地面摄影测量坐标
Dim Xcl#(1 To 4), Ycl#(1 To 4), Xcr#(1 To 4), Ycr#(1 To 4)      '控制点左片坐标和右片坐标
Dim n#, Xl#(), Yl#(), Xr#(), Yr#()                              '待测点像片坐标（立体量测得到）
Dim X#(), Y#(), Z#()                                            '待测点地面测量坐标（前方交会结果）

Dim fai_L#, omg_L#, kap_L#, XsL#, YsL#, ZsL#                    '左片外方位元素
Dim fai_R#, omg_R#, kap_R#, XsR#, YsR#, ZsR#                    '左片外方位元素
Dim Bx#, By#, Bz#                                               '基线分量
Dim R_L#(1 To 3, 1 To 3), R_R#(1 To 3, 1 To 3)                  '左右像片的旋转矩阵

Const RU = 206265


'显示“关于”窗体的过程
Private Sub mnuAbout_Click()
    frmAbout.Show
End Sub

'输入控制点地面坐标，供空间后方交会使用
Private Sub mnuInputGCP_Click()
    Dim strTemp As String, dblTemp As Double
    
    CDg1.Filter = "Text Files(*.TXT)|*.txt|All Files(*.*)|*.*"
    CDg1.DialogTitle = "读取已知数据"
    CDg1.FileName = "":                   CDg1.Action = 1

    If CDg1.FileName = "" Then Exit Sub
    
    Open CDg1.FileName For Input As #1
        Line Input #1, strTemp      '读第一行题头信息
        txtShow.Text = txtShow.Text & vbCrLf & strTemp & vbCrLf
        '读入控制点地面坐标
        Input #1, Xt(1), Yt(1), Zt(1)
        Input #1, Xt(2), Yt(2), Zt(2)
        Input #1, Xt(3), Yt(3), Zt(3)
        Input #1, Xt(4), Yt(4), Zt(4)
        '显示读入的控制点地面坐标
        txtShow.Text = txtShow.Text & Xt(1) & " , " & Yt(1) & " , " & Zt(1) & vbCrLf
        txtShow.Text = txtShow.Text & Xt(2) & " , " & Yt(2) & " , " & Zt(2) & vbCrLf
        txtShow.Text = txtShow.Text & Xt(3) & " , " & Yt(3) & " , " & Zt(3) & vbCrLf
        txtShow.Text = txtShow.Text & Xt(4) & " , " & Yt(4) & " , " & Zt(4) & vbCrLf
    Close #1
End Sub

'输入像片有关信息，供空间后方交会计算使用
Private Sub mnuInputInfo_Click()
    Dim strTemp As String, dblTemp As Double

    CDg1.Filter = "Text Files(*.TXT)|*.txt|All Files(*.*)|*.*"
    CDg1.DialogTitle = "读取已知数据"
    CDg1.FileName = "":                    CDg1.Action = 1
    If CDg1.FileName = "" Then Exit Sub
    
    Open CDg1.FileName For Input As #1
        Line Input #1, strTemp      '读第一行题头信息
        txtShow.Text = txtShow.Text & vbCrLf & strTemp