坐标系转换--二维七参数大地坐标系转换模型变换关系理解

二维七参数大地坐标系转换模型变换关系理解

[ Δ L Δ B ] = [ − sin ⁡ L N cos ⁡ B ρ cos ⁡ L N cos ⁡ B ρ 0 − sin ⁡ B cos ⁡ L M ρ − sin ⁡ B sin ⁡ L M ρ cos ⁡ B M ρ ] [ T x T y T z ] + [ tan ⁡ B cos ⁡ L tan ⁡ B sin ⁡ L − 1 − sin ⁡ L cos ⁡ L 0 ] [ R x R y R z ] + [ 0 − N M e 2 sin ⁡ B cos ⁡ B ρ ] D + [ 0 0 N M a e 2 sin ⁡ B cos ⁡ B ρ 2 − e 2 s i n 2 B 1 − f sin ⁡ B cos ⁡ B ρ ] [ Δ a Δ f ] (1) \tag{1} \begin{bmatrix} \varDelta L \\ \varDelta B \end{bmatrix} = \begin{bmatrix} -\frac{ \sin{L} }{ N\cos{B} }\rho & \frac{ \cos{L} }{ N\cos{B} }\rho & 0 \\ \\ -\frac{\sin{B}\cos{L}}{M}\rho & -\frac{\sin{B}\sin{L}}{M}\rho & \frac{\cos{B}}{M}\rho \end{bmatrix} \begin{bmatrix} T_x \\ T_y \\ T_z \end{bmatrix} + \\ \begin{bmatrix} \tan{B}\cos{L} & \tan{B}\sin{L} & -1 \\ \\ -\sin{L} & \cos{L} & 0 \end{bmatrix} \begin{bmatrix} R_x \\ R_y \\ R_z \end{bmatrix} + \\ \begin{bmatrix} 0 \\ \\ -\frac{N}{M}e^2\sin{B}\cos{B}\rho \end{bmatrix}D + \\ \begin{bmatrix} 0 & 0 \\ \\ \frac{N}{Ma}e^2\sin{B}\cos{B}\rho & \frac{2-e^2sin^2B}{1-f}\sin{B}\cos{B}\rho \end{bmatrix} \begin{bmatrix} \varDelta{a} \\ \varDelta{f} \end{bmatrix} [ΔLΔB]= NcosBsinLρMsinBcosLρNcosBcosLρMsinBsinLρ0McosBρ TxTyTz + tanBcosLsinLtanBsinLcosL10 RxRyRz + 0MNe2sinBcosBρ D+ 0MaNe2sinBcosBρ01f2e2sin2BsinBcosBρ [ΔaΔf](1)

式中: 式中: 式中:
e 2 :第一偏心率的平方,无量纲 e 2 = 2 f − f 2 ; e^2:第一偏心率的平方,无量纲e^2=2f-f^2; e2:第一偏心率的平方,无量纲e2=2ff2
M :地球椭球子午圈曲率半径,单位为米 ( m ) , M = a ( 1 − e 2 ) ( 1 − e 2 sin ⁡ 2 B ) 3 2 ; M:地球椭球子午圈曲率半径,单位为米(m),M=\frac{a(1-e^2)}{(1-e^2\sin^2{B})^{\frac{3}{2}}}; M:地球椭球子午圈曲率半径,单位为米(m)M=(1e2sin2B)23a(1e2)
N :地球椭球卯酉圈曲率半径,单位为米 ( m ) , N = a ( 1 − e 2 sin ⁡ 2 B ) 1 2 ; N:地球椭球卯酉圈曲率半径,单位为米(m),N=\frac{a}{(1-e^2\sin^2{B})^{\frac{1}{2}}}; N:地球椭球卯酉圈曲率半径,单位为米(m)N=(1e2sin2B)21a
B , L :点位纬度、经度,经纬度单位为弧度 ( r a d ) ; B,L:点位纬度、经度,经纬度单位为弧度(rad); B,L:点位纬度、经度,经纬度单位为弧度(rad)
Δ B , Δ L :点位在两个坐标系下的纬度差、经度差,经纬度差值单位为角秒 ( ′ ′ ) ; \varDelta{B},\varDelta{L}:点位在两个坐标系下的纬度差、经度差,经纬度差值单位为角秒(''); ΔB,ΔL:点位在两个坐标系下的纬度差、经度差,经纬度差值单位为角秒(′′)
ρ :角度与弧度间转换量,单位为角秒 ( ′ ′ ) , ρ = 180 × 3600 π ; \rho:角度与弧度间转换量,单位为角秒(''),\rho=180 \times \frac{3600}{\pi}; ρ:角度与弧度间转换量,单位为角秒(′′)ρ=180×π3600
a , Δ a :椭球长半轴和长半轴差,单位为米 ( m ) ; a,\varDelta{a}:椭球长半轴和长半轴差,单位为米(m); a,Δa:椭球长半轴和长半轴差,单位为米(m)
f , Δ f :椭球扁率和扁率差,无量纲; f,\varDelta{f}:椭球扁率和扁率差,无量纲; f,Δf:椭球扁率和扁率差,无量纲;
T x , T y , T z :平移参数,单位为米 ( m ) ; T_x,T_y,T_z:平移参数,单位为米(m); Tx,Ty,Tz:平移参数,单位为米(m)
R x , R y , R z :旋转参数,单位为角秒 ( ′ ′ ) ; R_x,R_y,R_z:旋转参数,单位为角秒(''); Rx,Ry,Rz:旋转参数,单位为角秒(′′)
D :尺度参数,无量纲。 D:尺度参数,无量纲。 D:尺度参数,无量纲。

令 令
a 0 = − sin ⁡ L N cos ⁡ B ρ , a 1 = cos ⁡ L N cos ⁡ B ρ , a_0=-\frac{ \sin{L} }{ N\cos{B} }\rho,a_1=\frac{ \cos{L} }{ N\cos{B} }\rho, a0=NcosBsinLρa1=NcosBcosLρ
a 3 = − sin ⁡ B cos ⁡ L M ρ , a 4 = − sin ⁡ B sin ⁡ L M ρ , a 5 = cos ⁡ B M ρ , a_3=-\frac{\sin{B}\cos{L}}{M}\rho,a_4=-\frac{\sin{B}\sin{L}}{M}\rho,a_5=\frac{\cos{B}}{M}\rho, a3=MsinBcosLρa4=MsinBsinLρa5=McosBρ
b 0 = tan ⁡ B cos ⁡ L , b 1 = tan ⁡ B sin ⁡ L , b_0=\tan{B}\cos{L},b_1=\tan{B}\sin{L}, b0=tanBcosLb1=tanBsinL
b 3 = − sin ⁡ L , b 4 = cos ⁡ L , b_3=-\sin{L},b_4=\cos{L}, b3=sinLb4=cosL
c 1 = − N M e 2 sin ⁡ B cos ⁡ B ρ c_1=-\frac{N}{M}e^2\sin{B}\cos{B}\rho c1=MNe2sinBcosBρ
d 2 = N M a e 2 sin ⁡ B cos ⁡ B ρ , d 3 = 2 − e 2 s i n 2 B 1 − f sin ⁡ B cos ⁡ B ρ d_2=\frac{N}{Ma}e^2\sin{B}\cos{B}\rho,d_3=\frac{2-e^2sin^2B}{1-f}\sin{B}\cos{B}\rho d2=MaNe2sinBcosBρd3=1f2e2sin2BsinBcosBρ

则 ( 1 ) 式变换为: 则(1)式变换为: (1)式变换为:
[ Δ L Δ B ] = [ a 0 a 1 0 a 3 a 4 a 5 ] [ T x T y T z ] + [ b 0 b 1 − 1 b 3 b 4 0 ] [ R x R y R z ] + [ 0 c 1 ] D + [ 0 0 d 2 d 3 ] [ Δ a Δ f ] = [ a 0 T x + a 1 T y + 0 T z + b 0 R x + b 1 R y − 1 R z + 0 D a 3 T x + a 4 T y + a 5 T z + b 3 R x + b 4 R y + 0 R z + c 1 D ] + [ 0 d 2 Δ a + d 3 Δ f ] (2) \tag{2} \begin{bmatrix} \varDelta L \\ \varDelta B \end{bmatrix} = \begin{bmatrix} a_0 & a_1 & 0 \\ a_3 & a_4 & a_5 \end{bmatrix} \begin{bmatrix} T_x \\ T_y \\ T_z \end{bmatrix} + \begin{bmatrix} b_0 & b_1 & -1 \\ b_3 & b_4 & 0 \end{bmatrix} \begin{bmatrix} R_x \\ R_y \\ R_z \end{bmatrix} + \begin{bmatrix} 0 \\ c_1 \end{bmatrix}D + \begin{bmatrix} 0 & 0 \\ d_2 & d_3 \end{bmatrix} \begin{bmatrix} \varDelta{a} \\ \varDelta{f} \end{bmatrix} \\ = \begin{bmatrix} a_0T_x+a_1T_y+ 0T_z+b_0R_x+b_1R_y-1R_z+0D \\ a_3T_x+a_4T_y+a_5T_z+b_3R_x+b_4R_y+0R_z+c_1D \end{bmatrix} + \begin{bmatrix} 0 \\ d_2\varDelta{a} + d_3\varDelta{f} \end{bmatrix} [ΔLΔB]=[a0a3a1a40a5] TxTyTz +[b0b3b1b410] RxRyRz +[0c1]D+[0d20d3][ΔaΔf]=[a0Tx+a1Ty+0Tz+b0Rx+b1Ry1Rz+0Da3Tx+a4Ty+a5Tz+b3Rx+b4Ry+0Rz+c1D]+[0d2Δa+d3Δf](2)

又 ∵ 又\because
[ a 0 T x + a 1 T y + 0 T z + b 0 R x + b 1 R y − 1 R z + 0 D a 3 T x + a 4 T y + a 5 T z + b 3 R x + b 4 R y + 0 R z + c 1 D ] = [ P 1 P 2 P 3 P 4 P 5 P 6 P 7 P 8 P 9 P 10 P 11 P 12 P 13 P 14 ] [ T x T y T z R x R y R z D ] \begin{bmatrix} a_0T_x+a_1T_y+ 0T_z+b_0R_x+b_1R_y-1R_z+0D \\ a_3T_x+a_4T_y+a_5T_z+b_3R_x+b_4R_y+0R_z+c_1D \end{bmatrix} = \begin{bmatrix} P_1 & P_2 & P_3 & P_4 & P_5 & P_6 & P_7 \\ P_8 & P_9 & P_{10} & P_{11} & P_{12} & P_{13} & P_{14} \end{bmatrix} \begin{bmatrix} T_x \\ T_y \\ T_z \\ R_x \\ R_y \\ R_z \\ D \end{bmatrix} [a0Tx+a1Ty+0Tz+b0Rx+b1Ry1Rz+0Da3Tx+a4Ty+a5Tz+b3Rx+b4Ry+0Rz+c1D]=[P1P8P2P9P3P10P4P11P5P12P6P13P7P14] TxTyTzRxRyRzD
⇒ \Rarr
P 1 = a 0 , P 2 = a 1 , P 3 = 0 , P 4 = b 0 , P 5 = b 1 , P 6 = − 1 , P 7 = 0 , P 8 = a 3 , P 9 = a 4 , P 10 = a 5 , P 11 = b 3 , P 12 = b 4 , P 13 = 0 , P 14 = c 1 P_1=a_0, P_2=a_1, P_3=0, P_4=b_0, P_5=b_1, P_6=-1, P_7=0, \\ P_8=a_3, P_9=a_4, P_{10}=a_5,P_{11}=b_3,P_{12}=b_4,P_{13}=0,P_{14}=c_1 P1=a0P2=a1P3=0P4=b0P5=b1P6=1P7=0P8=a3P9=a4P10=a5P11=b3P12=b4P13=0P14=c1
∴ ( 2 ) 式变换为: \therefore (2)式变换为: (2)式变换为:
[ Δ L Δ B ] = [ a 0 a 1 0 b 0 b 1 − 1 0 a 3 a 4 a 5 b 3 b 4 0 c 1 ] [ T x T y T z R x R y R z D ] + [ 0 d 2 Δ a + d 3 Δ f ] (3) \tag{3} \begin{bmatrix} \varDelta L \\ \varDelta B \end{bmatrix} = \begin{bmatrix} a_0 & a_1 & 0 & b_0 & b_1 & -1 & 0 \\ a_3 & a_4 & a_5 & b_3 & b_4 & 0 & c_1 \end{bmatrix} \begin{bmatrix} T_x \\ T_y \\ T_z \\ R_x \\ R_y \\ R_z \\ D \end{bmatrix} + \begin{bmatrix} 0 \\ d_2\varDelta{a} + d_3\varDelta{f} \end{bmatrix} [ΔLΔB]=[a0a3a1a40a5b0b3b1b4100c1] TxTyTzRxRyRzD +[0d2Δa+d3Δf](3)

基于最小二乘与多对同名点对计算参数

设存在 n 对同名点对: ( L a , B a ) 1 → ( L b , B b ) 1 , ⋯ , ( L a , B a ) n → ( L b , B b ) n . 设存在n对同名点对:(L_a,B_a)_1 \rarr (L_b,B_b)_1,\cdots,(L_a,B_a)_n \rarr (L_b,B_b)_n. 设存在n对同名点对:(La,Ba)1(Lb,Bb)1(La,Ba)n(Lb,Bb)n.
令 令
θ = [ T x T y T z R x R y R z D ] \theta =\begin{bmatrix} T_x \\ T_y \\ T_z \\ R_x \\ R_y \\ R_z \\ D \end{bmatrix} θ= TxTyTzRxRyRzD
Δ L i = ( L b − L a ) i , Δ B i = ( B b − B a ) i , Δ H i = ( H b − H a ) i \varDelta{L}_i=(L_b-L_a)_i,\varDelta{B}_i=(B_b-B_a)_i,\varDelta{H}_i=(H_b-H_a)_i ΔLi=(LbLa)iΔBi=(BbBa)iΔHi=(HbHa)i
v i = ( Δ L − 0 , Δ B − ( d 2 Δ a + d 3 Δ f ) ) i T , v_i=(\varDelta{L} - 0,\varDelta{B} - (d_2\varDelta{a} + d_3\varDelta{f}))^T_i, vi=(ΔL0,ΔB(d2Δa+d3Δf))iT
P i = [ a 0 a 1 0 b 0 b 1 − 1 0 a 3 a 4 a 5 b 3 b 4 0 c 1 ] i , P_i= \begin{bmatrix} a_0 & a_1 & 0 & b_0 & b_1 & -1 & 0 \\ a_3 & a_4 & a_5 & b_3 & b_4 & 0 & c_1 \end{bmatrix}_i, Pi=[a0a3a1a40a5b0b3b1b4100c1]i
i = 1 , ⋯   , n i=1,\cdots,n i=1,,n

根据式 ( 3 ) ,代入样本值得到方程组如下: 根据式(3),代入样本值得到方程组如下: 根据式(3),代入样本值得到方程组如下:
{ P 1 θ = v 1 P 2 θ = v 2 ⋮ P n θ = v n \begin{dcases} P_1\theta = v_1 \\ P_2\theta = v_2 \\ \vdots \\ P_n\theta = v_n \end{dcases} P1θ=v1P2θ=v2Pnθ=vn
则变换为矩阵方程为: 则变换为矩阵方程为: 则变换为矩阵方程为:
v = P θ v = P\theta v=
P = [ P 1 P 2 ⋮ P n ] , v = [ v 1 v 2 ⋮ v n ] P= \begin{bmatrix} P_1 \\ P_2 \\ \vdots \\ P_n \end{bmatrix}, v= \begin{bmatrix} v_1 \\ v_2 \\ \vdots \\ v_n \end{bmatrix} P= P1P2Pn v= v1v2vn

考虑 v = P θ 无解,需要从 P 的列空间中找出最接近 v 的向量 u ( u 可以理解为 v 在 P 的列空间中的投影,理解如下图所示:) 考虑v = P\theta无解,需要从P的列空间中找出最接近v的向量u(u可以理解为v在P的列空间中的投影,理解如下图所示:) 考虑v=无解,需要从P的列空间中找出最接近v的向量uu可以理解为vP的列空间中的投影,理解如下图所示:)
在这里插入图片描述

如上图所示, p 是 b 在 [ a 1 a 2 ] 列空间中的投影。 如上图所示,p是b在\begin{bmatrix} a_1 & a_2 \end{bmatrix} 列空间中的投影。 如上图所示,pb[a1a2]列空间中的投影。
令 e = v − u ,最小二乘就是找到 ∥ e ∥ 2 最小的点,最小二乘就是指向量长度的最小平方。 令e=v-u,最小二乘就是找到\parallel e \parallel^2最小的点,最小二乘就是指向量长度的最小平方。 e=vu,最小二乘就是找到e2最小的点,最小二乘就是指向量长度的最小平方。

由上可知, u 位于 P 的列空间中,即 u 是 P 的各列的线性组合: 由上可知,u位于P的列空间中,即u是P的各列的线性组合: 由上可知,u位于P的列空间中,即uP的各列的线性组合:
令 P 的列空间为 P = [ C 1 C 2 ⋯ C m ] 令P的列空间为 P= \begin{bmatrix} C_1 & C_2 & \cdots & C_m \end{bmatrix} P的列空间为P=[C1C2Cm]
故存在 u = C 1 θ 1 ~ + C 2 θ 2 ~ + ⋯ + C m θ m ~ 故存在 u=C_1\tilde{\theta_1} + C_2\tilde{\theta_2} + \cdots + C_m\tilde{\theta_m} 故存在u=C1θ1~+C2θ2~++Cmθm~
即 P θ ~ = u 有解。 即P\tilde{\theta}=u有解。 Pθ~=u有解。

e = v − u = v − P θ ~ e=v-u=v-P\tilde{\theta} e=vu=vPθ~
e 正交于 P 的列空间,存在: e正交于P的列空间,存在: e正交于P的列空间,存在:
e ⊥ C 1 , e ⊥ C 2 , ⋯   , e ⊥ C m e \perp C_1,e \perp C_2,\cdots,e \perp C_m eC1,eC2,,eCm

由向量点积关系式可得: 由向量点积关系式可得: 由向量点积关系式可得:

⇒ { C 1 T ( v − P θ ~ ) = 0 C 2 T ( v − P θ ~ ) = 0 ⋮ C m T ( v − P θ ~ ) = 0 \Rarr \begin{dcases} C_1^T(v-P\tilde{\theta})=0 \\ C_2^T(v-P\tilde{\theta})=0 \\ \vdots \\ C_m^T(v-P\tilde{\theta})=0 \end{dcases} C1T(vPθ~)=0C2T(vPθ~)=0CmT(vPθ~)=0

⇒ [ C 1 T C 2 T C 3 T ⋮ C m T ] ( v − P θ ~ ) = [ 0 0 0 ⋮ 0 ] \Rarr \begin{bmatrix} C_1^T \\ C_2^T \\ C_3^T \\ \vdots \\ C_m^T \end{bmatrix} (v-P\tilde{\theta})= \begin{bmatrix} 0 \\ 0 \\ 0 \\ \vdots \\ 0 \end{bmatrix} C1TC2TC3TCmT (vPθ~)= 0000

∵ P = [ C 1 C 2 ⋯ C m ] \because P= \begin{bmatrix} C_1 & C_2 & \cdots & C_m \end{bmatrix} P=[C1C2Cm]
∴ P T = [ C 1 T C 2 T ⋮ C m T ] \therefore P^T = \begin{bmatrix} C_1^T \\ C_2^T \\ \vdots \\ C_m^T \end{bmatrix} PT= C1TC2TCmT

⇒ P T ( v − P θ ~ ) = 0 \Rarr P^T(v-P\tilde{\theta})=0 PT(vPθ~)=0
⇒ P T P θ ~ = P T v \Rarr P^TP\tilde{\theta}=P^Tv PTPθ~=PTv
⇒ θ ~ = ( P T P ) − 1 P T v \Rarr \tilde{\theta}=(P^TP)^{-1}P^Tv θ~=(PTP)1PTv

即 θ ~ = ( P T P ) − 1 P T v 为基于最小二乘计算出来的最接近实际参数的转换值 即\tilde{\theta}=(P^TP)^{-1}P^Tv为基于最小二乘计算出来的最接近实际参数的转换值 θ~=(PTP)1PTv为基于最小二乘计算出来的最接近实际参数的转换值

  • 1
    点赞
  • 2
    收藏
    觉得还不错? 一键收藏
  • 1
    评论
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值