最小二乘法求解平面坐标转换四参数

四参数的转换公式为:

\begin{bmatrix} x_{2}\\ y_{2} \end{bmatrix}= \begin{bmatrix} \Delta x\\ \Delta y \end{bmatrix}+ m\begin{bmatrix} cos\alpha &-sin\alpha \\ sin\alpha & cos\alpha \end{bmatrix}\begin{bmatrix} x_{1}\\ y_{1} \end{bmatrix}

构造条件方程:

\begin{bmatrix} x_{2}\\ y_{2} \end{bmatrix} - \begin{bmatrix} x_{1}\\ y_{1} \end{bmatrix}= \begin{bmatrix} \Delta x\\ \Delta y \end{bmatrix}+ \begin{bmatrix} mcos\alpha &-msin\alpha \\ msin\alpha & mcos\alpha \end{bmatrix}\begin{bmatrix} x_{1}\\ y_{1} \end{bmatrix}-\begin{bmatrix} 1 &0 \\ 0 & 1 \end{bmatrix}\begin{bmatrix} x_{1}\\ y_{1} \end{bmatrix}\Rightarrow

\begin{bmatrix} x_{2}\\ y_{2} \end{bmatrix} - \begin{bmatrix} x_{1}\\ y_{1} \end{bmatrix}= \begin{bmatrix} \Delta x\\ \Delta y \end{bmatrix}+ \begin{bmatrix} mcos\alpha -1 &-msin\alpha \\ msin\alpha & mcos\alpha -1\end{bmatrix}\begin{bmatrix} x_{1}\\ y_{1} \end{bmatrix}

a = mcosa-1, b=msina,有:

\begin{bmatrix} x_{2}\\ y_{2} \end{bmatrix} - \begin{bmatrix} x_{1}\\y_{1} \end{bmatrix} =\begin{bmatrix} \Delta x\\ \Delta y\ \end{bmatrix} + \begin{bmatrix} a & -b\\ b & a \end{bmatrix}\begin{bmatrix} x_{1}\\ y_{1} \end{bmatrix} \Rightarrow \begin{bmatrix} x_{2}\\ y_{2} \end{bmatrix} - \begin{bmatrix} x_{1}\\y_{1} \end{bmatrix} =\begin{bmatrix} \Delta x\\ \Delta y \end{bmatrix} + \begin{bmatrix} x_{1} & -y_{1}\\ y_{1} & x_{1} \end{bmatrix}\begin{bmatrix} a\\b \end{bmatrix}

等价表达:

  \begin{bmatrix} x_{2}\\ y_{2} \end{bmatrix} - \begin{bmatrix} x_{1}\\y_{1} \end{bmatrix} = \begin{bmatrix} 1&0&x_{1}&-y_{1}\\0&1&y_{1}&x_{1} \end{bmatrix}\begin{bmatrix} \Delta x \\ \Delta y \\a\\b\end{bmatrix}

其中,Li=\begin{bmatrix} x_{2i}\\ y_{2i} \end{bmatrix} - \begin{bmatrix} x_{1i}\\y_{1i} \end{bmatrix}Bi=\begin{bmatrix} 1 &0& x_{1i} &-y_{1i} \\ 0 &1 &y_{1i} & x_{1i} \end{bmatrix}X=\begin{bmatrix} \Delta x\\ \Delta y \\ a \\ b\end{bmatrix}

即:

最小二乘法求解平面坐标转换四参数_第1张图片,B=\begin{bmatrix} 1 &0& x_{11} &-y_{11} \\ 0 &1 &y_{11} & x_{11} \\ &&... \\ 1 &0& x_{1i} &-y_{1i} \\ 0 &1 &y_{1i} & x_{1i} \\ &&...\\ 1 &0& x_{1n} &-y_{1n} \\ 0 &1 &y_{1n} & x_{1n} \\ \end{bmatrix},X=\begin{bmatrix} \Delta x\\ \Delta y \\ a \\ b\end{bmatrix}P=\begin{bmatrix} 1& 0 &0 &0 \\ 0 & 1 & 0 &0 \\ 0 & 0 & 1&0 \\ 0 &0 &0 & 1 \end{bmatrix}

根据最小二乘原理计算X:

X=(B^TPB)^-^1B^TPL

解得X后,可知ab,可解得m和α:

\left\{\begin{matrix}a = m\cos \alpha-1\\ b = m\sin \alpha \end{matrix}\right \Rightarrow \left\{\begin{matrix} \sin \alpha/\cos \alpha = b/(a +1) \\ (a+1)^2 + b^2 = m^2(\cos ^2 \alpha +\sin^2 \alpha) \end{matrix}\right. \Rightarrow \left\{\begin{matrix} \alpha = \arctan[b/(a+1)] \\ m = \sqrt{(a+1)^2+b^2} \end{matrix}\right.

你可能感兴趣的:(坐标转换,最小二乘,四参数)