基于羅德里格矩陣的空間坐標轉換

韓夢澤，李克昭

(1.河南理工大學 測繪與國土信息工程學院，河南 焦作 454003；2.商丘工學院 土木工程學院，河南 商丘 476000)

?

基于羅德里格矩陣的空間坐標轉換

韓夢澤1,2，李克昭1

(1.河南理工大學 測繪與國土信息工程學院，河南 焦作 454003；2.商丘工學院 土木工程學院，河南 商丘 476000)

摘要：三維坐標轉換一直是測量領域的一個重要內容。針對現有算法普遍存在的不適用大旋角轉換、計算繁雜等缺點，從旋轉矩陣的表達方式入手，提出了一種基于羅德里格矩陣的三維坐標轉換方法。算例分析表明,文中方法無需線性化，計算簡便，且能適用大旋角轉換。

關鍵詞：坐標轉換；旋轉參數；羅德里格矩陣

不同空間直角坐標系之間的坐標轉換一直是測繪領域的一個重要內容，國內外很多學者在這方面做了大量研究[1-5]。空間坐標轉換的實質是用公共點的2套坐標和非公共點的1套坐標推估非公共點的另1套坐標。坐標轉換過程通常分2步，先由公共點坐標解算轉換參數，再由轉換參數轉換非公共點。轉換參數通常分為旋轉、平移和尺度參數，其中旋轉參數的確定是坐標轉換的核心。傳統的三維坐標轉換模型是用3個旋轉角作為旋轉參數，建立的模型是非線性的，常需要用泰勒級數展開的方法將模型線性化，計算比較繁雜[6-8]。在小角度旋轉情況下，可對旋轉矩陣作近似處理，得到線性模型，如常用的布爾莎模型[9]。針對大旋角的坐標轉換問題，陳義提出了一種用9個方向余弦參數作為旋轉參數的解算模型，雖然能適用大旋角轉換，但參數個數達到了13個[10]。游為直接從三維直角坐標轉換的非線性方程出發，根據最優化問題的極值條件，采用基于同倫連續思想的Li-Yorke算法求解7個轉換參數，雖然能適用大旋角轉換，但計算較復雜[11]。針對這些情況，本文提出了一種用羅德里格矩陣表示旋轉矩陣的坐標轉換方法，僅有3個旋轉參數，計算過程無需線性化，且能適用大旋角轉換。

1空間坐標轉換的數學模型

設A點在空間直角坐標系o-uvw和o-xyz中的坐標分別為(u,v,w)和(x,y,z);a1,a2,a3為軸u與軸x,y,z間夾角的余弦;b1,b2,b3為軸v與軸x,y,z間夾角的余弦;c1,c2,c3為軸w與軸x,y,z間夾角的余弦;λ為尺度參數;(Δx,Δy,Δz)為平移參數，則有如下關系：

(1)

方向余弦矩陣通常由繞3個坐標軸順次旋轉的歐拉角φ,ω,κ表示，這時需要求取的轉換參數為λ,φ,ω,κ,Δx,Δy,Δz。

2基于羅德里格矩陣的三維坐標轉換模型

2.1羅德里格矩陣

羅德里格矩陣可由反對稱矩陣構建，引入一個具有3個獨立元素的反對稱矩陣

則R=(I+S)(I-S)-1是個正交矩陣，其中I是3階單位陣。

將R展開為

(3)

這個正交矩陣就是羅德里格矩陣。

2.2轉換參數的求解

用羅德里格矩陣表示方向余弦矩陣時，需要求取的轉換參數為λ,a,b,c,Δx,Δy,Δz。參數解算過程可分3步，先求尺度參數，再求旋轉參數，最后求平移參數。尺度參數可由2個公共點在不同坐標系下的距離之比算出，其表達式為

(4)

公共點較多時，可求出各點間多個距離比，再取平均值。

在解算旋轉參數a,b,c時，可以先消去平移參數，將2個公共點的坐標代入式(1)，求差得

(5)

上式兩端同時左乘(I-S)得

(6)

由R=(I+S)(I-S)-1知(I-S)R=(I+S)，將其代入式(6)得

(7)

將I和S代入，整理得

(8)

式中:u21=u2-u1，v21=v2-v1，w21=w2-w1，x21=x2-x1，y21=y2-y1，z21=z2-z1。

這個方程組左邊的系數矩陣為奇異陣，3個方程里僅有2個獨立，需要至少2個這樣的方程組才能解算出a,b,c，也就是至少需要3個公共點。當有n個公共點時，可列出(n-1)個形如上式的方程組，共有3(n-1)個方程，其總誤差方程為

式中:

按最小二乘法間接平差原理求解未知數

(10)

計算出a,b,c后，即可求出旋轉矩陣，然后按下式求解平移參數：

(11)

3算例分析

為驗證上文算法的適用性，現用一組模擬數據進行計算分析。空間坐標轉換的核心是確定旋轉參數，尺度參數和平移參數的求取是很簡單的，為了更簡明的驗證本文的算法，這里將尺度參數設為1，將3個平移參數都設為0。目標坐標系與原坐標系間坐標軸按Y軸、X軸、Z軸的順序旋轉，旋轉角度依次為2°、4°和6°，則旋轉矩陣為

設3個點在原坐標系中的坐標分別為(5,8,15)、(10,10,10)、(20,30,40)，則由旋轉矩陣可計算出其在目標坐標系下的坐標為(3.591 0,7.411 8,15.689 8)、(8.519 6,10.266 2,11.046 4)、(15.274 1,29.058 2,42.688 7)。由這3個點的2套坐標，用上文的算法計算出的羅德里格參數a,b,c分別為0.034 0、0.019 3、0.053 0，羅德里格矩陣為

可見，R2與R1相差極小，僅有3個方向余弦值不同，且都是相差0.000 1。需要指出的是，用MATLAB計算數值，默認的顯示精度是到小數點后4位，當顯示精度設置為更高時，R2與R1的差值會更小。

上面的算例是小角度旋轉的情況，為了更好地驗證本文算法的適用性，現再模擬一組大角度旋轉下的數據。坐標軸的旋轉順序不變，旋轉角度依次為20°、40°和60°，則旋轉矩陣為

設3個點在原坐標系中的坐標分別為(5,8,15)、(10,10,10)、(20,30,40)，則由旋轉矩陣計算出的其在目標坐標系下的坐標為(-9.922 5,-3.260 6,14.314 7)、(-9.062 7,4.036 5,14.197 7)、(-32.602 7,-0.952 6,42.850 4)。由這3個點的2套坐標，用上文的算法計算出的羅德里格參數a,b,c分別為0.272 3、0.401 3、0.666 2，旋轉矩陣為

可見，R4與R3相差極小，僅有2個方向余弦值不同，且都是相差0.000 1。由以上算例分析可知，本文的模型是正確的，可用于小角度和大角度旋轉的坐標轉換，且轉換精度很高。

4結束語

本文從旋轉矩陣的表達方式入手，用羅德里格矩陣表示方向余弦矩陣，推導了基于羅德里格矩陣的三維坐標轉換模型。與常規的坐標轉換模型相比，該模型用代數運算替代了三角運算，無需對旋轉參數線性化，模型簡單，計算簡便，可用于大旋角的坐標轉換，且具有很高的轉換精度。

參考文獻：

[1]王解先,王軍,陸彩萍.WGS-84與北京54坐標的轉換問題[J].大地測量與地球動力學,2003,23(3):70-73.

[2]田桂娥,宋利杰,尹利文.地方坐標系與CGCS2000坐標系轉換方法的研究[J].測繪工程,2014,23(8):66-69.

[3]李博峰,沈云中,李微曉.無縫三維基準轉換模型[J].中國科學:地球科學,2012,42(7):1047-1054.

[4]劉毅,岳建平,盧銀宏,等.補償最小二乘法在大地坐標轉換中的應用[J].測繪工程,2012,21(5):80-82.

[5]段鵬碩,劉根友,龔有亮,等.空間坐標系變換的函數梯度描述方法[J].測繪學報,2014,43(10):1005-1012.

[6]張卡,張道俊,盛業華,等.三維坐標轉換的兩種方法及其比較研究[J].數學的實踐與認識,2008,38(23):121-128.

[7]許文學,王保豐,羊遠新,等.坐標系轉換參數初值快速計算的新方法[J].測繪工程,2010,19(4):4-7.

[8]潘國榮,周躍寅.兩種坐標系轉換計算方法的比較[J].大地測量與地球動力學,2011,31(3):58-62.

[9]鮑建寬,李永利,李秀海.大地坐標轉換模型及其應用[J].測繪工程,2013,22(3):56-60.

[10] 陳義,沈云中,劉大杰.適用于大旋轉角的三維基準轉換的一種簡便模型[J].武漢大學學報(信息科學版),2004,29(12):1101-1105.

[11] 游為,范東明,黃瑞金.適用于任意旋轉角的三維直角坐標轉換方法[J].測繪科學,2009,34(5):154-155.

[責任編輯：劉文霞]

Spatial coordinate transformation based on Rodrigues matrix

HAN Mengze1,2,LI Kezhao1

(1.School of Surveying and Land Information Engineering,Henan Polytechnic University,Jiaozuo 454003,China；2.College of Civil Engineering,Shangqiu Institute of Technology,Shangqiu 476000,China)

Abstract：The three-dimensional coordinate transformation has always been an important content in the field of surveying and mapping.The existing algorithms are usually difficult to calculate or can’t adapt to big angle rotation transformation.The transformation model based on Lodrigues matrix was deducted.Numerical examples show that the method is feasible and simple,which needn’t linearization and can adapt to big angle rotation transformation.

Key words：coordinate transformation；rotation parameters；Rodrigues matrix

中圖分類號：P226+.3

文獻標識碼：A

文章編號：1006-7949(2016)04-0025-03

作者簡介：韓夢澤(1988-)，男，碩士.

基金項目：國家自然科學基金資助項目(41272373，41202245)

收稿日期：2015-01-03