專利名稱:電子羅盤校正方法、裝置和設備的制作方法
技術領域:
本發明涉及導航技術,特別是涉及一種電子羅盤校正方法、裝置和設備。
背景技術:
隨著導航技術的廣泛應用,電子羅盤由于具備體積小等優點而被廣泛應用于車輛導航等各種領域中。隨著電子羅盤所在終端的移動,電子羅盤的使用環境將各有差別,受到的干擾也在不斷地變化。傳統的電子羅盤校正是通過對電子羅盤進行一個三維旋轉或者三個二維旋轉實現的。在電子羅盤的旋轉過程中,將記錄地球磁場分量,即XH、yH、和ZH,這些地球磁場分量將會形成一個偏離原點的橢球面,根據記錄的地球磁場分量即可擬合得到這一橢球面的參數,并將擬合得到的參數與基準的單位球面進行對照,以校正記錄的地球磁場分量,進而根據校正的地球磁場分量得到電子羅盤的航向角。這一傳統的電子羅盤校正在各種干擾環境中不得不實時對電子羅盤進行旋轉無法適用于電子羅盤的實時校正,從而大大影響了電子羅盤的精度。
發明內容
基于此,有必要針對電子羅盤無法實時校正,精度不高的問題,提供一種能提高電子羅盤精度的電子羅盤校正方法。此外,還有必要提供一種能提高電子羅盤精度的電子羅盤校正裝置。另外,還有必要提供一種能提高電子羅盤精度的電子羅盤校正設備。一種電子羅盤校正方法,包括如下步驟:運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角;通過置于底板中的加速度計采集得到加速度信息;獲取存儲的校正參數,分別根據所述相對傾角、加速度信息以及校正參數得到所述相對傾角所在的面對應的航向角;處理所述計算得到的相對傾角所在的面對應的航向角,得到所述電子羅盤的航向角。在其中一個實施例中,所述獲取存儲的校正參數,分別根據所述相對傾角、加速度信息以及校正參數得到所述相對傾角所在的面對應的航向角的步驟包括:根據所述加速度信息和所述相對傾角計算得到所述相對傾角所在的面對應的絕對傾角;獲取存儲的校正參數;獲取設置于所述幾何體框架的面上的傳感器所采集得到的磁力數據,根據所述校正參數對所述磁力數據進行校正,并通過所述校正后的磁力數據和絕對傾角計算得到所述相對傾角所在的面對應的航向角。在其中一個實施例中,所述處理所述計算得到的相對傾角所在的面對應的航向角,得到所述電子羅盤的航向角的步驟包括:從所述計算得到的航向角中,按照從小到大的順序提取預設數量的航向角讀數,對所述提取的航向角讀數取平均值,并將所述平均值設置為所述電子羅盤的航向角。在其中一個實施例中,所述獲取存儲的校正參數的步驟之前還包括:對所述電子羅盤進行三維球面旋轉;通過設置于所述幾何體框架的面上的傳感器采集所述電子羅盤進行三維球面旋轉產生的磁力數據;對所述采集得到的磁力數據通過橢球法處理得到校正參數,并存儲所述校正參數。一種電子羅盤校正裝置,包括:相對傾角運算模塊,用于運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角;加速度計,設置于底板中,用于采集加速度信息;第一處理模塊,用于獲取存儲的校正參數,分別根據所述相對傾角、加速度信息以及校正參數得到所述相對傾角所在的面對應的航向角;第二處理模塊,用于處理所述計算得到的相對傾角所在的面對應的航向角,得到所述電子羅盤的航向角。在其中一個實施例中,所述第一處理模塊包括:絕對傾角計算單元,用于根據所述加速度信息和所述相對傾角計算得到所述相對傾角所在的面對應的絕對傾角;參數獲取單元,用于獲取存儲的校正參數;航向角計算單元,用于獲取設置于所述幾何體框架的面上的傳感器所采集得到的磁力數據,根據所述校正參數對所述磁力數據進行校正,并通過所述校正后的磁力數據和絕對傾角計算得到所述相對傾角所在的面對應的航向角。在其中一個實施例中,所述第二處理模塊還用于從所述計算得到的航向角中,按照從小到大的順序提取預設數量的航向角讀數,對所述提取的航向角讀數取平均值,并將所述平均值設置為所述電子羅盤的航向角。在其中一個實施例中,所述裝置還包括:旋轉模塊,用于對所述電子羅盤進行三維球面旋轉;傳感器,設置于所述幾何體框架的面上,用于采集所述電子羅盤進行三維球面旋轉產生的磁力數據;橢球法處理模塊,用于對所述采集得到的磁力數據通過橢球法處理得到校正參數,并存儲所述校正參數?!N電子羅盤校正設備,包括底盤裝置、加速度計和控制模塊;所述底盤裝置包括底板和安裝于底板上的幾何體框架;所述控制模塊用于運算所述幾何體框架上的面相對于底板的相對傾角;所述加速度計設置于所述底板中,用于采集加速度信息;所述控制模塊還用于獲取存儲的校正參數,分別根據所述相對傾角、加速度信息以及校正參數得到所述相對傾角所在的面對應的航向角,處理所述計算得到的相對傾角所在的面對應的航向角,得到電子羅盤的航向角。在其中一個實施例中,所述設備還包括多個傳感器,所述傳感器分別安裝于幾何體框架的面上,用于采集所述電子羅盤進行三維球面旋轉產生的磁力數據;所述控制模塊還用于對所述采集得到的磁力數據通過橢球法處理得到校正參數,并存儲所述校正參數。上述電子羅盤校正方法、裝置和設備,運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角,通過設置于底板上的加速度計采集得到當前的加速度信息,進而獲取存儲的校正參數,以應用校正參數、加速度信息和相對傾角進行運算得到相對傾角所在的面對應的航向角,進而由運算得到的多個航向角確定電子羅盤的航向角,由于使用的是預先存儲的校正參數,因此,在每一次校正過程中不需要對旋轉電子羅盤,進而實現了電子羅盤的實時校正,避免了旋轉電子羅盤所帶來的不便和低效,將有效對抗外界干擾,提高電子羅盤的精度。
圖1為一個實施例中電子羅盤校正方法的流程圖;圖2為一個實施例中底盤裝置的結構示意圖;圖3為圖2中幾何體框架的結構示意圖;圖4為一個實施例中獲取存儲的校正參數,分別根據相對傾角、加速度信息以及校正參數得到相對傾角所在的面對應的航向角的方法流程圖;圖5為另一個實施例中電子羅盤校正方法的流程圖;圖6為現實環境中磁力數據所形成的橢球面示意圖;圖7為理想環境中磁力數據所形成的橢球面示意圖;圖8為一個實施例中電子羅盤校正裝置的結構示意圖;圖9為一個實施例中第一處理模塊的結構不意圖;圖10為另一個實施例中電子羅盤校正裝置的結構示意圖;圖11為一個實施例中電子羅盤校正設備的結構示意圖。
具體實施例方式如圖1所示,在一個實施例中,一種電子羅盤校正方法,包括如下步驟:步驟S110,運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角。本實施例中,如圖2和圖3所示,底盤裝置包括底板201和安裝于底板201之上的幾何體框架203,幾何體框架203可以是多面體或旋轉體,例如,幾何體框架203可以是正多面體或球體。根據幾何體框架203的幾何特性運算幾何體框架上每一個面相對于底板的相對傾角,例如,若幾何體框架203為正十二面體,則根據正十二面體的幾何特性,正十二面體中面與面的夾角為;r-arccos(√5/5),約為116.565051177078°,此時,可得到正十二面體
中面與棱的夾角為(4*180-2*h-arccos(√5/5)))/4,從而根據面與面的夾角和面與棱的夾角計算得到正十二面體中所有面與底板之間的傾角,即正十二面體上的面相對于底盤裝置的底板的相對傾角。步驟S130,通過設置于底板中的加速度計采集得到加速度信息。本實施例中,加速度計被安裝于底盤裝置的底板上,可以是三軸加速度傳感器,用于實時采集加速度信息,其中,加速度信息包括了 X軸和y軸上的加速度分量。步驟S150,獲取存儲的校正參數,分別根據相對傾角、加速度信息以及校正參數得到相對傾角所在的面對應的航向角。本實施例中,校正參數被預先存儲,在優選的實施例中,校正參數被預先存儲于外接的存儲芯片中,該存儲芯片可安裝于底盤裝置的底板上。應用計算得到的多個相對傾角、加速度計采集得到的加速度信息和校正參數進行運算,以得到相對傾角所在的面對應的航向角。步驟S170,處理計算得到的相對傾角所在的面對應的航向角,得到電子羅盤的航向角。本實施例中,應用相對傾角、加速度信息和校正參數所運算得到的航向角為多個,即運算得到的每一航向角均是與相對傾角和相對傾角所在的面相對應的。對運算所得到的多個航向角進行處理以確定電子羅盤當前所對應的航向角,進而實現電子羅盤的校正。如圖4所示,在一個實施例中,上述步驟S150包括:步驟S151,根據加速度信息和相對傾角計算得到相對傾角所在的面對應的絕對傾角。本實施例中, 由于每一個面均有與其對應的相對傾角,因此,根據加速度信息和該面所對應的相對傾角計算得到該面所對應的絕對傾角。根據置于底板這一平面上的加速度計所采集得到的加速度信息和每一個面所對應的相對傾角進行計算,得到該面所對應的絕對傾角。具體的,根據加速度信息所包含的X軸和y軸上的加速度分量X和y直接計算得到底板傾角,該底板傾角包括底板的俯仰角pitch和滾轉角roll,其中,pitch = P =arcsin (~x), roll = y = arcsin (y/cos P ),進而根據俯仰角 pitch、滾轉角 roll 和每一個面所對應的相對傾角即可得到該面所對應的絕對傾角。步驟S153,獲取存儲的校正參數。本實施例中,讀取預先存儲的校正參數。步驟S155,獲取設置于幾何體框架上的傳感器所采集的磁力數據,根據校正參數對磁力數據進行校正,并通過校正后的磁力數據和絕對傾角計算得到相對傾角所在的面對應的航向角。本實施例中,底盤裝置中安裝于底板上的幾何體框架的每個面將分別安裝傳感器,以采集不同方向的磁力數據。獲取采集得到的磁力數據,根據校正參數對磁力數據進行校正,進而根據校正后的磁力數據和絕對傾角進行計算得到相應的航向角。具體的,根據絕對傾角得到空間坐標旋轉矩陣MR,通過校正后的磁力數據MG和空間坐標旋轉矩陣MR得到空間磁場在水平面上水平方向和垂直方向的磁力分量M,即M=MG*MR,然后使用公式Heading = ¥ = arctan (My/Mx),其中,Mx為空間磁場在水平面上水平方向上的分量,My為空間磁場在水平面上垂直方向上的分量,Heading為計算得到的航向角。在一個實施例中,上述步驟S170的具體過程為:從計算得到的航向角中按照從小到大的順序提取預設數量的航向角讀數,對提取的航向角讀數取平均值,并將平均值設置為電子羅盤的航向角。本實施例中,計算得到的多個航向角是分別與幾何體框架中的面逐一對應的,從多個航向角中按照從小到大的順序提取預設數量的航向角讀數,以確定電子羅盤的航向角,其中,提取的航向角讀數的數量可以是一個或者多個,根據實際需求靈活設定。如圖5所示,在一個實施例中,上述獲取存儲的校正參數的步驟之前還包括如下步驟:步驟S210,對電子羅盤進行三維球面旋轉。本實施例中,在遠離磁干擾物(如汽車、高壓線)的環境中,例如,較開闊的場地,對電子羅盤進行三維球面旋轉。其中,電子羅盤所進行的三維球面旋轉可以是在單位球面上圍繞球心做三維隨機旋轉。步驟S230,通過設置于幾何體框架的面上的傳感器采集電子羅盤進行三維球面旋轉產生的磁力數據。本實施例中,在幾何體框架的面上分別安裝傳感器,在優選的實施例中,可將傳感器安裝于電路板上,制成多個單獨的傳感器控制小板,將每一個傳感器控制小板固定于幾何體框架的一個面上,以使得幾何體框架中的每一個面均設置了傳感器,實現不同方向的磁力數據采集,避免了轉動電子羅盤所帶來的不便和低效,通過多傳感器協同校正,屏蔽動態的環境干擾。電子羅盤進行三維球面旋轉的過程中,安裝于幾何體框架上的多個傳感器將實時采集磁力數據。步驟S250,對采集得到的磁力數據通過橢球法處理得到校正參數,并存儲校正參數。本實施例中,在理想環境下,若未受到干擾,則傳感器所采集到的磁力數據是在以(0,0,0)為球心的球面上的,如圖6所示,然而,在現實環境中,采集到的磁力數據受到了各種干擾的影響,形成了一個偏離球心的傾斜的橢球面,如圖7所示,因此,需要計算校正參數,進而應用校正參數對采集的磁力數據進行校正。具體的,采集到的磁力數據所形成的橢球面表達式為:(x-x0) 2/a2+ (y_y。) 2/b2+ (z-z0) 2/c2 = R2其中,x,y, z為采集到的磁力數據,R為地磁場強度常量,x0, y0, z0, a, b, c為要獲得的校正參數。將上式改寫成矩陣形式,即:
X2 =[xj;z -/ -Z2 1][ 2x0 2(a2/*”)',0 2(a2/c2)z0 a-jb1 a2/c2 a2R2-xl-(a2/h2)J02-{a2/c2)Z20設Wmd = x2,[H]m6 = [x y z -y2 -Z2 I],
Z6xl = 2x0 I^a21b2) V0 2(a2/c2)z0 a2fir a2/c2 a1 R1-X02-(o2/^2) fl-{a21c2)Z20
則Wnxl = [H]nx6 □ X6xl,根據最小二乘法得X = [HtHF1Ht □ ff,根據改寫的矩陣形式可計算得到校正參數Xci, y0, z0, a, b, c的值。如圖8所示,在一個實施例中,一種電子羅盤校正裝置,包括相對傾角運算模塊110、加速度計130、第一處理模塊150和第二處理模塊170。相對傾角運算模塊110,用于運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角。本實施例中,底盤裝置包括底板和安裝于底板之上的幾何體框架,幾何體框架可以是多面體或旋轉體,例如,幾何體框架可以是正多面體或球體。根據幾何體框架的幾何特性運算幾何體框架上每一個面相對于底板的相對傾角,例如,若幾何體框架為正十二面體,則根據正十二面體的幾何特性,正十二面體中面與面的夾角為:-arccos(V5 /5),約為116.565051177078°,此時,可得到正十二面體中面與棱的
夾角為(4 * 180 — 2 * (疋-arccos(V5 / 5))) / 4,從而根據面與面的夾角和面與棱的夾角計算得
到正十二面體中所有面與底板之間的傾角,即正十二面體上的面相對于底盤裝置的底板的相對傾角。加速度計130,設置于底板中,用于采集加速度信息。本實施例中,加速度計130被安裝于底盤裝置的底板上,可以是三軸加速度傳感器,用于實時采集加速度信息,其中,加速度信息包括了 X軸和y軸上的加速度分量。第一處理模塊150,用于獲取存儲的校正參數,分別根據相對傾角、加速度信息以及校正參數得到相對傾角所在的面對應的航向角。本實施例中,校正參數被預先存儲,在優選的實施例中,校正參數被預先存儲于外接的存儲芯片中,該存儲芯片可安裝于底盤裝置的底板上。第一處理模塊150應用計算得到的多個相對傾角、加速度計采集得到的加速度信息和校正參數進行運算,以得到相對傾角所在的面對應的航向角。第二處理模塊170,用于處理計算得到的相對傾角所在的面對應的航向角,得到電子羅盤的航向角。本實施例中,第一處理模塊150應用相對傾角、加速度信息和校正參數所運算得到的航向角為多個,即運算得到的每一航向角均是與相對傾角和相對傾角所在的面相對應的。第二處理模塊170對運算所得到的多個航向角進行處理以確定電子羅盤當前所對應的航向角,進而實現電子羅盤的校正。如圖9所示,在一個實施例中,上述第一處理模塊150包括絕對傾角計算單元151、參數獲取單元153和航向角計算單元155。絕對傾角計算單元151,用于根據加速度信息和相對傾角計算得到相對傾角所在的面對應的絕對 傾角。本實施例中,由于每一個面均有與其對應的相對傾角,因此,絕對傾角計算單元151根據加速度信息和該面所對應的相對傾角計算得到該面所對應的絕對傾角。絕對傾角計算單元151根據置于底板這一平面上的加速度計所采集得到的加速度信息和每一個面所對應的相對傾角進行計算,得到該面所對應的絕對傾角。具體的,絕對傾角計算單元151根據加速度信息所包含的X軸和y軸上的加速度分量X和y直接計算得到底板傾角,該底板傾角包括底板的俯仰角pitch和滾轉角roll,其中,pitch = P = arcsin (-x) ,roll = y = arcsin (y/cos P ),進而根據俯仰角 pitch、滾轉角roll和每一個面所對應的相對傾角即可得到該面所對應的絕對傾角。參數獲取單元153,用于獲取存儲的校正參數。本實施例中,參數獲取單元153讀取預先存儲的校正參數。航向角計算單元155,用于獲取設置于幾何體框架上的傳感器所采集的磁力數據,根據校正參數對磁力數據進行校正,并通過校正后的磁力數據和絕對傾角計算得到相對傾角所在的面對應的航向角。本實施例中,底盤裝置中安裝于底板上的幾何體框架的每個面將分別安裝傳感器,以采集不同方向的磁力數據。航向角計算單元155獲取采集得到的磁力數據,根據校正參數對磁力數據進行校正,進而根據校正后的磁力數據和絕對傾角進行計算得到相應的航向角。具體的,航向角計算單元155根據絕對傾角得到空間坐標旋轉矩陣MR,通過校正后的磁力數據MG和空間坐標旋轉矩陣MR得到空間磁場在水平面上水平方向和垂直方向的磁力分量M,即M=MG*MR,然后使用公式Heading = ¥ = arctan (My/Mx),其中,Mx為空間磁場在水平面上水平方向上的分量,My為空間磁場在水平面上垂直方向上的分量,Heading為計算得到的航向角。在一個實施例中,上述第二處理模塊170還用于從計算得到的航向角中,按照從小到大的順序提取預設數量的航向角讀數,對提取的航向角讀數取平均值,并將平均值設置為電子羅盤的航向角。 本實施例中,第二處理模塊170計算得到的多個航向角是分別與幾何體框架中的面逐一對應的,從多個航向角中按照從小到大的順序提取預設數量的航向角讀數,以確定電子羅盤的航向角,其中,提取的航向角讀數的數量可以是一個或者多個,根據實際需求靈活設定。如圖10所示,在另一個實施例中,上述電子羅盤校正裝置還包括旋轉模塊210、傳感器230和橢球法處理模塊250。旋轉模塊210,用于對電子羅盤進行三維球面旋轉。本實施例中,在遠離磁干擾物(如汽車、高壓線)的環境中,例如,較開闊的場地,旋轉模塊210對電子羅盤進行三維球面旋轉。其中,電子羅盤所進行的三維球面旋轉可以是在單位球面上圍繞球心做三維隨機旋轉。傳感器230,設置于幾何體框架的面上,用于采集電子羅盤進行三維球面旋轉產生的磁力數據。本實施例中,在幾何體框架的面上分別安裝傳感器230,在優選的實施例中,可將傳感器230安裝于電路板上,制成多個單獨的傳感器控制小板,將每一個傳感器控制小板固定于幾何體框架的一個面上,以使得幾何體框架中的每一個面均設置了傳感器230,實現不同方向的磁力數據采集,避免了轉動電子羅盤所帶來的不便和低效,通過多傳感器協同校正,屏蔽動態的環境干擾。
電子羅盤進行三維球面旋轉的過程中,安裝于幾何體框架上的多個傳感器230將實時采集磁力數據。橢球法處理模塊250,用于對采集得到的磁力數據通過橢球法處理得到校正參數,并存儲校正參數。本實施例中,在理想環境下,若未受到干擾,則傳感器所采集到的磁力數據是在以(0,0,0)為球心的球面上的,然而,在現實環境中,采集到的磁力數據受到了各種干擾的影響,形成了一個偏離球心的傾斜的橢球面,因此,需要橢球法處理模塊250計算校正參數,進而應用校正參數對采集的磁力數據進行校正。具體的,采集到的磁力數據所形成的橢球面表達式為:
權利要求
1.一種電子羅盤校正方法,包括如下步驟: 運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角; 通過置于底板中的加速度計采集得到加速度信息; 獲取存儲的校正參數,分別根據所述相對傾角、加速度信息以及校正參數得到所述相對傾角所在的面對應的航向角; 處理所述計算得到的相對傾角所在的面對應的航向角,得到所述電子羅盤的航向角。
2.根據權利要求1所述的電子羅盤校正方法,其特征在于,所述獲取存儲的校正參數,分別根據所述相對傾角、加速度信息以及校正參數得到所述相對傾角所在的面對應的航向角的步驟包括: 根據所述加速度信息和所述相對傾角計算得到所述相對傾角所在的面對應的絕對傾角; 獲取存儲的校正參數; 獲取設置于所述幾何體框架的面上的傳感器所采集得到的磁力數據,根據所述校正參數對所述磁力數據進行校正,并通過所述校正后的磁力數據和絕對傾角計算得到所述相對傾角所在的面對應的航向角。
3.根據權利要求1所述的電子羅盤校正方法,其特征在于,所述處理所述計算得到的相對傾角所在的面對應的航向角,得到所述電子羅盤的航向角的步驟包括: 從所述計算得到的航向角中,按照從小到大的順序提取預設數量的航向角讀數,對所述提取的航向角讀數取平均值,并將所述平均值設置為所述電子羅盤的航向角。
4.根據權利要求1所述的電子羅盤校正方法,其特征在于,所述獲取存儲的校正參數的步驟之前還包括: 對所述電子羅盤進行三維球面旋轉; 通過設置于所述幾何體框架的面上的傳感器采集所述電子羅盤進行三維球面旋轉產生的磁力數據; 對所述采集得到的磁力數據通過橢球法處理得到校正參數,并存儲所述校正參數。
5.一種電子羅盤校正裝置,其特征在于,包括: 相對傾角運算模塊,用于運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角; 加速度計,設置于底板中,用于采集加速度信息; 第一處理模塊,用于獲取存儲的校正參數,分別根據所述相對傾角、加速度信息以及校正參數得到所述相對傾角所在的面對應的航向角; 第二處理模塊,用于處理所述計算得到的相對傾角所在的面對應的航向角,得到所述電子羅盤的航向角。
6.根據權利要求5所述的電子羅盤校正裝置,其特征在于,所述第一處理模塊包括: 絕對傾角計算單元,用于根據所述加速度信息和所述相對傾角計算得到所述相對傾角所在的面對應的絕對傾角; 參數獲取單元,用于獲取存儲的校正參數; 航向角計算單元,用于獲取設置于所述幾何體框架的面上的傳感器所采集得到的磁力數據,根據所述校正參數對所述磁力數據進行校正,并通過所述校正后的磁力數據和絕對傾角計算得到所述相對傾角所在的面對應的航向角。
7.根據權利要求5所述的電子羅盤校正裝置,其特征在于,所述第二處理模塊還用于從所述計算得到的航向角中,按照從小到大的順序提取預設數量的航向角讀數,對所述提取的航向角讀數取平均值,并將所述平均值設置為所述電子羅盤的航向角。
8.根據權利要求5所述的電子羅盤校正裝置,其特征在于,所述裝置還包括: 旋轉模塊,用于對所述電子羅盤進行三維球面旋轉; 傳感器,設置于所述幾何體框架的面上,用于采集所述電子羅盤進行三維球面旋轉產生的磁力數據; 橢球法處理模塊,用于對所述采集得到的磁力數據通過橢球法處理得到校正參數,并存儲所述校正參數。
9.一種電子羅盤校正設備,其特征在于,包括底盤裝置、加速度計和控制模塊; 所述底盤裝置包括底板和安裝于底板上的幾何體框架; 所述控制模塊用于運算所述幾何體框架上的面相對于底板的相對傾角; 所述加速度計設置于所述底板中,用于采集加速度信息; 所述控制模塊還用于獲取存儲的校正參數,分別根據所述相對傾角、加速度信息以及校正參數得到所述相對傾角所在的面對應的航向角,處理所述計算得到的相對傾角所在的面對應的航向角,得到電子羅盤的航向角。
10.根據權利要求9所述的電 子羅盤校正設備,其特征在于,所述設備還包括多個傳感器,所述傳感器分別安裝于幾何體框架的面上,用于采集所述電子羅盤進行三維球面旋轉產生的磁力數據; 所述控制模塊還用于對所述采集得到的磁力數據通過橢球法處理得到校正參數,并存儲所述校正參數。
全文摘要
本發明提供了一種電子羅盤校正方法、裝置及設備。所述方法包括運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角;通過置于底板中的加速度計采集得到加速度信息;獲取存儲的校正參數,分別根據所述相對傾角、加速度信息以及校正參數得到所述相對傾角所在的面對應的航向角;處理所述計算得到的相對傾角所在的面對應的航向角,得到所述電子羅盤的航向角。采用本發明能提高電子羅盤精度。
文檔編號G01C17/38GK103175520SQ20131009032
公開日2013年6月26日 申請日期2013年3月20日 優先權日2013年3月20日
發明者譚光, 謝波, 毛成華, 魯鳴鳴 申請人:中國科學院深圳先進技術研究院