攝影測量學單像空間后方交會編程實習報告(編輯修改稿)
2024-08-31 00:19 本頁面
【文章內容簡介】 內外方位元素初始值 x0=0。y0=0。 f=。 m=15000。 Xs=0。Ys=0。 q=0。w=0。k=0。 for (int i=0。i4。i++) { Xs += X0[i]。 Ys += Y0[i]。 } Xs /= 4。 Ys /= 4。 Zs=f*m。 Matrix A(8, 6)。 Matrix L(8, 1)。 Matrix AT(6, 8)。 Matrix ATA(6, 6)。 Matrix ATA_(6, 6)。 Matrix Xx(6, 1)。 //迭代計算 do { //旋轉矩陣R a1 = cos(q)*cos(k) sin(q)*sin(w)*sin(k)。 a2 = cos(q)*sin(k) sin(q)*sin(w)*cos(k)。 a3 = sin(q)*cos(w)。 b1 = cos(w)*sin(k)。 b2 = cos(w)*cos(k)。 b3 = sin(w)。 c1 = sin(q)*cos(k) + cos(q)*sin(w)*sin(k)。 c2 = sin(q)*sin(k) + cos(q)*sin(w)*cos(k)。 c3 = cos(q)*cos(w)。 //計算像點坐標 for (int i = 0。 i 4。 i++) { double X = a1 * ( X0[i] Xs) + b1 * (Y0[i] Ys) + c1 * (Z0[i] Zs)。 double Y = a2 * ( X0[i] Xs) + b2 * (Y0[i] Ys) + c2 * (Z0[i] Zs)。 double Z = a3 * ( X0[i] Xs) + b3 * (Y0[i] Ys) + c3 * (Z0[i] Zs)。 double xx = x[i]x0。 double yy = y[i]y0。 A[2 * i][0] = (a1*f + a3*xx) / Z。 A[2 * i][1] = (b1*f + b3*xx) / Z。 A[2 * i][2] = (c1*f + c3*xx) / Z。 A[2 * i][3] = yy*sin(w) (xx*(xx*cos(k) yy*sin(k)) / f + f*cos(k))*cos(w)。 A[2 * i][4] = f*
醫(yī)療健康相關推薦
鄂ICP備17016276號-1