久久一区二区免费播放,国产在线欧美日韩一区二区,国产综合色在线视频,精品伊人久久久香线蕉,精品视频麻豆网站,玖玖国产,国内精品久久久久影,在线观看精品视频一区二区三区,午夜久久影院,国产精品一区久久

專利名稱：電子羅盤校正方法、裝置和設備的制作方法
技術領域：
本發(fā)明涉及導航技術，特別是涉及一種電子羅盤校正方法、裝置和設備。
背景技術：
隨著導航技術的廣泛應用，電子羅盤由于具備體積小等優(yōu)點而被廣泛應用于車輛導航等各種領域中。隨著電子羅盤所在終端的移動，電子羅盤的使用環(huán)境將各有差別，受到的干擾也在不斷地變化。傳統(tǒng)的電子羅盤校正是通過對電子羅盤進行一個三維旋轉或者三個二維旋轉實現(xiàn)的。在電子羅盤的旋轉過程中，將記錄地球磁場分量，即XH、yH、和ZH，這些地球磁場分量將會形成一個偏離原點的橢球面，根據(jù)記錄的地球磁場分量即可擬合得到這一橢球面的參數(shù)，并將擬合得到的參數(shù)與基準的單位球面進行對照，以校正記錄的地球磁場分量，進而根據(jù)校正的地球磁場分量得到電子羅盤的航向角。這一傳統(tǒng)的電子羅盤校正在各種干擾環(huán)境中不得不實時對電子羅盤進行旋轉無法適用于電子羅盤的實時校正，從而大大影響了電子羅盤的精度。

發(fā)明內容
基于此，有必要針對電子羅盤無法實時校正，精度不高的問題，提供一種能提高電子羅盤精度的電子羅盤校正方法。此外，還有必要提供一種能提高電子羅盤精度的電子羅盤校正裝置。另外，還有必要提供一種能提高電子羅盤精度的電子羅盤校正設備。一種電子羅盤校正方法，包括如下步驟:運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角；通過置于底板中的加速度計采集得到加速度信息；獲取存儲的校正參數(shù)，分別根據(jù)所述相對傾角、加速度信息以及校正參數(shù)得到所述相對傾角所在的面對應的航向角；處理所述計算得到的相對傾角所在的面對應的航向角，得到所述電子羅盤的航向角。在其中一個實施例中，所述獲取存儲的校正參數(shù)，分別根據(jù)所述相對傾角、加速度信息以及校正參數(shù)得到所述相對傾角所在的面對應的航向角的步驟包括:根據(jù)所述加速度信息和所述相對傾角計算得到所述相對傾角所在的面對應的絕對傾角；獲取存儲的校正參數(shù)；獲取設置于所述幾何體框架的面上的傳感器所采集得到的磁力數(shù)據(jù)，根據(jù)所述校正參數(shù)對所述磁力數(shù)據(jù)進行校正，并通過所述校正后的磁力數(shù)據(jù)和絕對傾角計算得到所述相對傾角所在的面對應的航向角。在其中一個實施例中，所述處理所述計算得到的相對傾角所在的面對應的航向角，得到所述電子羅盤的航向角的步驟包括:從所述計算得到的航向角中，按照從小到大的順序提取預設數(shù)量的航向角讀數(shù)，對所述提取的航向角讀數(shù)取平均值，并將所述平均值設置為所述電子羅盤的航向角。在其中一個實施例中,所述獲取存儲的校正參數(shù)的步驟之前還包括:對所述電子羅盤進行三維球面旋轉；通過設置于所述幾何體框架的面上的傳感器采集所述電子羅盤進行三維球面旋轉產生的磁力數(shù)據(jù)；對所述采集得到的磁力數(shù)據(jù)通過橢球法處理得到校正參數(shù)，并存儲所述校正參數(shù)。一種電子羅盤校正裝置，包括:相對傾角運算模塊，用于運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角；加速度計，設置于底板中，用于采集加速度信息；第一處理模塊，用于獲取存儲的校正參數(shù)，分別根據(jù)所述相對傾角、加速度信息以及校正參數(shù)得到所述相對傾角所在的面對應的航向角；第二處理模塊，用于處理所述計算得到的相對傾角所在的面對應的航向角，得到所述電子羅盤的航向角。在其中一個實施例中，所述第一處理模塊包括:絕對傾角計算單元，用于根據(jù)所述加速度信息和所述相對傾角計算得到所述相對傾角所在的面對應的絕對傾角；參數(shù)獲取單元,用于獲取存儲的校正參數(shù)；航向角計算單元，用于獲取設置于所述幾何體框架的面上的傳感器所采集得到的磁力數(shù)據(jù)，根據(jù)所述校正參數(shù)對所述磁力數(shù)據(jù)進行校正，并通過所述校正后的磁力數(shù)據(jù)和絕對傾角計算得到所述相對傾角所在的面對應的航向角。在其中一個實施例中，所述第二處理模塊還用于從所述計算得到的航向角中，按照從小到大的順序提取預設數(shù)量的航向角讀數(shù)，對所述提取的航向角讀數(shù)取平均值，并將所述平均值設置為所述電子羅盤的航向角。在其中一個實施例中，所述裝置還包括:旋轉模塊，用于對所述電子羅盤進行三維球面旋轉；傳感器，設置于所述幾何體框架的面上，用于采集所述電子羅盤進行三維球面旋轉產生的磁力數(shù)據(jù)；橢球法處理模塊，用于對所述采集得到的磁力數(shù)據(jù)通過橢球法處理得到校正參數(shù)，并存儲所述校正參數(shù)?！N電子羅盤校正設備，包括底盤裝置、加速度計和控制模塊；所述底盤裝置包括底板和安裝于底板上的幾何體框架；所述控制模塊用于運算所述幾何體框架上的面相對于底板的相對傾角；所述加速度計設置于所述底板中，用于采集加速度信息；所述控制模塊還用于獲取存儲的校正參數(shù)，分別根據(jù)所述相對傾角、加速度信息以及校正參數(shù)得到所述相對傾角所在的面對應的航向角，處理所述計算得到的相對傾角所在的面對應的航向角，得到電子羅盤的航向角。在其中一個實施例中，所述設備還包括多個傳感器，所述傳感器分別安裝于幾何體框架的面上，用于采集所述電子羅盤進行三維球面旋轉產生的磁力數(shù)據(jù)；所述控制模塊還用于對所述采集得到的磁力數(shù)據(jù)通過橢球法處理得到校正參數(shù)，并存儲所述校正參數(shù)。上述電子羅盤校正方法、裝置和設備，運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角，通過設置于底板上的加速度計采集得到當前的加速度信息，進而獲取存儲的校正參數(shù)，以應用校正參數(shù)、加速度信息和相對傾角進行運算得到相對傾角所在的面對應的航向角，進而由運算得到的多個航向角確定電子羅盤的航向角，由于使用的是預先存儲的校正參數(shù)，因此，在每一次校正過程中不需要對旋轉電子羅盤，進而實現(xiàn)了電子羅盤的實時校正，避免了旋轉電子羅盤所帶來的不便和低效，將有效對抗外界干擾，提高電子羅盤的精度。


圖1為一個實施例中電子羅盤校正方法的流程圖；圖2為一個實施例中底盤裝置的結構示意圖；圖3為圖2中幾何體框架的結構示意圖；圖4為一個實施例中獲取存儲的校正參數(shù)，分別根據(jù)相對傾角、加速度信息以及校正參數(shù)得到相對傾角所在的面對應的航向角的方法流程圖；圖5為另一個實施例中電子羅盤校正方法的流程圖；圖6為現(xiàn)實環(huán)境中磁力數(shù)據(jù)所形成的橢球面示意圖；圖7為理想環(huán)境中磁力數(shù)據(jù)所形成的橢球面示意圖；圖8為一個實施例中電子羅盤校正裝置的結構示意圖；圖9為一個實施例中第一處理模塊的結構不意圖；圖10為另一個實施例中電子羅盤校正裝置的結構示意圖；圖11為一個實施例中電子羅盤校正設備的結構示意圖。
具體實施例方式如圖1所示，在一個實施例中，一種電子羅盤校正方法，包括如下步驟:步驟S110，運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角。本實施例中，如圖2和圖3所示，底盤裝置包括底板201和安裝于底板201之上的幾何體框架203，幾何體框架203可以是多面體或旋轉體，例如，幾何體框架203可以是正多面體或球體。根據(jù)幾何體框架203的幾何特性運算幾何體框架上每一個面相對于底板的相對傾角，例如，若幾何體框架203為正十二面體，則根據(jù)正十二面體的幾何特性，正十二面體中面與面的夾角為;r-arccos(√5/5),約為116.565051177078°，此時，可得到正十二面體
中面與棱的夾角為(4*180-2*h-arccos(√5/5)))/4，從而根據(jù)面與面的夾角和面與棱的夾角計算得到正十二面體中所有面與底板之間的傾角，即正十二面體上的面相對于底盤裝置的底板的相對傾角。步驟S130，通過設置于底板中的加速度計采集得到加速度信息。本實施例中，加速度計被安裝于底盤裝置的底板上，可以是三軸加速度傳感器，用于實時采集加速度信息，其中，加速度信息包括了 X軸和y軸上的加速度分量。步驟S150，獲取存儲的校正參數(shù)，分別根據(jù)相對傾角、加速度信息以及校正參數(shù)得到相對傾角所在的面對應的航向角。本實施例中，校正參數(shù)被預先存儲，在優(yōu)選的實施例中，校正參數(shù)被預先存儲于外接的存儲芯片中，該存儲芯片可安裝于底盤裝置的底板上。應用計算得到的多個相對傾角、加速度計采集得到的加速度信息和校正參數(shù)進行運算，以得到相對傾角所在的面對應的航向角。步驟S170，處理計算得到的相對傾角所在的面對應的航向角，得到電子羅盤的航向角。本實施例中，應用相對傾角、加速度信息和校正參數(shù)所運算得到的航向角為多個，即運算得到的每一航向角均是與相對傾角和相對傾角所在的面相對應的。對運算所得到的多個航向角進行處理以確定電子羅盤當前所對應的航向角，進而實現(xiàn)電子羅盤的校正。如圖4所示，在一個實施例中，上述步驟S150包括:步驟S151，根據(jù)加速度信息和相對傾角計算得到相對傾角所在的面對應的絕對傾角。本實施例中， 由于每一個面均有與其對應的相對傾角，因此，根據(jù)加速度信息和該面所對應的相對傾角計算得到該面所對應的絕對傾角。根據(jù)置于底板這一平面上的加速度計所采集得到的加速度信息和每一個面所對應的相對傾角進行計算，得到該面所對應的絕對傾角。具體的，根據(jù)加速度信息所包含的X軸和y軸上的加速度分量X和y直接計算得到底板傾角，該底板傾角包括底板的俯仰角pitch和滾轉角roll,其中，pitch = P =arcsin (~x), roll = y = arcsin (y/cos P ),進而根據(jù)俯仰角 pitch、滾轉角 roll 和每一個面所對應的相對傾角即可得到該面所對應的絕對傾角。步驟S153，獲取存儲的校正參數(shù)。本實施例中，讀取預先存儲的校正參數(shù)。步驟S155，獲取設置于幾何體框架上的傳感器所采集的磁力數(shù)據(jù)，根據(jù)校正參數(shù)對磁力數(shù)據(jù)進行校正，并通過校正后的磁力數(shù)據(jù)和絕對傾角計算得到相對傾角所在的面對應的航向角。本實施例中，底盤裝置中安裝于底板上的幾何體框架的每個面將分別安裝傳感器，以采集不同方向的磁力數(shù)據(jù)。獲取采集得到的磁力數(shù)據(jù)，根據(jù)校正參數(shù)對磁力數(shù)據(jù)進行校正，進而根據(jù)校正后的磁力數(shù)據(jù)和絕對傾角進行計算得到相應的航向角。具體的，根據(jù)絕對傾角得到空間坐標旋轉矩陣MR，通過校正后的磁力數(shù)據(jù)MG和空間坐標旋轉矩陣MR得到空間磁場在水平面上水平方向和垂直方向的磁力分量M，即M=MG*MR,然后使用公式Heading = ￥ = arctan (My/Mx),其中,Mx為空間磁場在水平面上水平方向上的分量，My為空間磁場在水平面上垂直方向上的分量，Heading為計算得到的航向角。在一個實施例中，上述步驟S170的具體過程為:從計算得到的航向角中按照從小到大的順序提取預設數(shù)量的航向角讀數(shù)，對提取的航向角讀數(shù)取平均值，并將平均值設置為電子羅盤的航向角。本實施例中，計算得到的多個航向角是分別與幾何體框架中的面逐一對應的，從多個航向角中按照從小到大的順序提取預設數(shù)量的航向角讀數(shù)，以確定電子羅盤的航向角，其中，提取的航向角讀數(shù)的數(shù)量可以是一個或者多個，根據(jù)實際需求靈活設定。如圖5所示,在一個實施例中，上述獲取存儲的校正參數(shù)的步驟之前還包括如下步驟:步驟S210，對電子羅盤進行三維球面旋轉。本實施例中，在遠離磁干擾物(如汽車、高壓線)的環(huán)境中，例如，較開闊的場地，對電子羅盤進行三維球面旋轉。其中，電子羅盤所進行的三維球面旋轉可以是在單位球面上圍繞球心做三維隨機旋轉。步驟S230，通過設置于幾何體框架的面上的傳感器采集電子羅盤進行三維球面旋轉產生的磁力數(shù)據(jù)。本實施例中，在幾何體框架的面上分別安裝傳感器，在優(yōu)選的實施例中，可將傳感器安裝于電路板上，制成多個單獨的傳感器控制小板，將每一個傳感器控制小板固定于幾何體框架的一個面上，以使得幾何體框架中的每一個面均設置了傳感器，實現(xiàn)不同方向的磁力數(shù)據(jù)采集，避免了轉動電子羅盤所帶來的不便和低效，通過多傳感器協(xié)同校正，屏蔽動態(tài)的環(huán)境干擾。電子羅盤進行三維球面旋轉的過程中，安裝于幾何體框架上的多個傳感器將實時采集磁力數(shù)據(jù)。步驟S250，對采集得到的磁力數(shù)據(jù)通過橢球法處理得到校正參數(shù)，并存儲校正參數(shù)。本實施例中，在理想環(huán)境下，若未受到干擾，則傳感器所采集到的磁力數(shù)據(jù)是在以(0,0,0)為球心的球面上的，如圖6所示，然而，在現(xiàn)實環(huán)境中，采集到的磁力數(shù)據(jù)受到了各種干擾的影響，形成了一個偏離球心的傾斜的橢球面，如圖7所示，因此，需要計算校正參數(shù)，進而應用校正參數(shù)對采集的磁力數(shù)據(jù)進行校正。具體的，采集到的磁力數(shù)據(jù)所形成的橢球面表達式為:(x-x0) 2/a2+ (y_y。) 2/b2+ (z-z0) 2/c2 = R2其中，x，y, z為采集到的磁力數(shù)據(jù)，R為地磁場強度常量，x0, y0, z0, a, b, c為要獲得的校正參數(shù)。將上式改寫成矩陣形式，即:
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,根據(jù)最小二乘法得X = [HtHF1Ht □ ff,根據(jù)改寫的矩陣形式可計算得到校正參數(shù)Xci, y0, z0, a, b, c的值。如圖8所示，在一個實施例中，一種電子羅盤校正裝置，包括相對傾角運算模塊110、加速度計130、第一處理模塊150和第二處理模塊170。相對傾角運算模塊110，用于運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角。本實施例中，底盤裝置包括底板和安裝于底板之上的幾何體框架,幾何體框架可以是多面體或旋轉體，例如，幾何體框架可以是正多面體或球體。根據(jù)幾何體框架的幾何特性運算幾何體框架上每一個面相對于底板的相對傾角，例如，若幾何體框架為正十二面體，則根據(jù)正十二面體的幾何特性，正十二面體中面與面的夾角為:-arccos(V5 /5),約為116.565051177078°，此時，可得到正十二面體中面與棱的
夾角為(4 * 180 — 2 * (疋-arccos(V5 / 5))) / 4，從而根據(jù)面與面的夾角和面與棱的夾角計算得
到正十二面體中所有面與底板之間的傾角，即正十二面體上的面相對于底盤裝置的底板的相對傾角。加速度計130，設置于底板中，用于采集加速度信息。本實施例中，加速度計130被安裝于底盤裝置的底板上，可以是三軸加速度傳感器，用于實時采集加速度信息，其中，加速度信息包括了 X軸和y軸上的加速度分量。第一處理模塊150，用于獲取存儲的校正參數(shù)，分別根據(jù)相對傾角、加速度信息以及校正參數(shù)得到相對傾角所在的面對應的航向角。本實施例中，校正參數(shù)被預先存儲，在優(yōu)選的實施例中，校正參數(shù)被預先存儲于外接的存儲芯片中，該存儲芯片可安裝于底盤裝置的底板上。第一處理模塊150應用計算得到的多個相對傾角、加速度計采集得到的加速度信息和校正參數(shù)進行運算，以得到相對傾角所在的面對應的航向角。第二處理模塊170，用于處理計算得到的相對傾角所在的面對應的航向角，得到電子羅盤的航向角。本實施例中，第一處理模塊150應用相對傾角、加速度信息和校正參數(shù)所運算得到的航向角為多個，即運算得到的每一航向角均是與相對傾角和相對傾角所在的面相對應的。第二處理模塊170對運算所得到的多個航向角進行處理以確定電子羅盤當前所對應的航向角，進而實現(xiàn)電子羅盤的校正。如圖9所示,在一個實施例中，上述第一處理模塊150包括絕對傾角計算單元151、參數(shù)獲取單元153和航向角計算單元155。絕對傾角計算單元151，用于根據(jù)加速度信息和相對傾角計算得到相對傾角所在的面對應的絕對 傾角。本實施例中，由于每一個面均有與其對應的相對傾角，因此，絕對傾角計算單元151根據(jù)加速度信息和該面所對應的相對傾角計算得到該面所對應的絕對傾角。絕對傾角計算單元151根據(jù)置于底板這一平面上的加速度計所采集得到的加速度信息和每一個面所對應的相對傾角進行計算，得到該面所對應的絕對傾角。具體的，絕對傾角計算單元151根據(jù)加速度信息所包含的X軸和y軸上的加速度分量X和y直接計算得到底板傾角，該底板傾角包括底板的俯仰角pitch和滾轉角roll,其中，pitch = P = arcsin (-x) ,roll = y = arcsin (y/cos P ),進而根據(jù)俯仰角 pitch、滾轉角roll和每一個面所對應的相對傾角即可得到該面所對應的絕對傾角。參數(shù)獲取單元153,用于獲取存儲的校正參數(shù)。本實施例中，參數(shù)獲取單元153讀取預先存儲的校正參數(shù)。航向角計算單元155，用于獲取設置于幾何體框架上的傳感器所采集的磁力數(shù)據(jù)，根據(jù)校正參數(shù)對磁力數(shù)據(jù)進行校正，并通過校正后的磁力數(shù)據(jù)和絕對傾角計算得到相對傾角所在的面對應的航向角。本實施例中，底盤裝置中安裝于底板上的幾何體框架的每個面將分別安裝傳感器，以采集不同方向的磁力數(shù)據(jù)。航向角計算單元155獲取采集得到的磁力數(shù)據(jù)，根據(jù)校正參數(shù)對磁力數(shù)據(jù)進行校正，進而根據(jù)校正后的磁力數(shù)據(jù)和絕對傾角進行計算得到相應的航向角。具體的，航向角計算單元155根據(jù)絕對傾角得到空間坐標旋轉矩陣MR，通過校正后的磁力數(shù)據(jù)MG和空間坐標旋轉矩陣MR得到空間磁場在水平面上水平方向和垂直方向的磁力分量M,即M=MG*MR,然后使用公式Heading = ￥ = arctan (My/Mx),其中，Mx為空間磁場在水平面上水平方向上的分量，My為空間磁場在水平面上垂直方向上的分量，Heading為計算得到的航向角。在一個實施例中，上述第二處理模塊170還用于從計算得到的航向角中，按照從小到大的順序提取預設數(shù)量的航向角讀數(shù)，對提取的航向角讀數(shù)取平均值，并將平均值設置為電子羅盤的航向角。 本實施例中，第二處理模塊170計算得到的多個航向角是分別與幾何體框架中的面逐一對應的，從多個航向角中按照從小到大的順序提取預設數(shù)量的航向角讀數(shù)，以確定電子羅盤的航向角，其中，提取的航向角讀數(shù)的數(shù)量可以是一個或者多個，根據(jù)實際需求靈活設定。如圖10所示，在另一個實施例中，上述電子羅盤校正裝置還包括旋轉模塊210、傳感器230和橢球法處理模塊250。旋轉模塊210，用于對電子羅盤進行三維球面旋轉。本實施例中，在遠離磁干擾物(如汽車、高壓線)的環(huán)境中，例如，較開闊的場地，旋轉模塊210對電子羅盤進行三維球面旋轉。其中，電子羅盤所進行的三維球面旋轉可以是在單位球面上圍繞球心做三維隨機旋轉。傳感器230，設置于幾何體框架的面上，用于采集電子羅盤進行三維球面旋轉產生的磁力數(shù)據(jù)。本實施例中，在幾何體框架的面上分別安裝傳感器230，在優(yōu)選的實施例中，可將傳感器230安裝于電路板上，制成多個單獨的傳感器控制小板，將每一個傳感器控制小板固定于幾何體框架的一個面上，以使得幾何體框架中的每一個面均設置了傳感器230，實現(xiàn)不同方向的磁力數(shù)據(jù)采集，避免了轉動電子羅盤所帶來的不便和低效，通過多傳感器協(xié)同校正，屏蔽動態(tài)的環(huán)境干擾。
電子羅盤進行三維球面旋轉的過程中，安裝于幾何體框架上的多個傳感器230將實時采集磁力數(shù)據(jù)。橢球法處理模塊250，用于對采集得到的磁力數(shù)據(jù)通過橢球法處理得到校正參數(shù)，并存儲校正參數(shù)。本實施例中，在理想環(huán)境下，若未受到干擾，則傳感器所采集到的磁力數(shù)據(jù)是在以(0，0，0)為球心的球面上的，然而，在現(xiàn)實環(huán)境中，采集到的磁力數(shù)據(jù)受到了各種干擾的影響，形成了一個偏離球心的傾斜的橢球面，因此，需要橢球法處理模塊250計算校正參數(shù)，進而應用校正參數(shù)對采集的磁力數(shù)據(jù)進行校正。具體的，采集到的磁力數(shù)據(jù)所形成的橢球面表達式為:
權利要求
1.一種電子羅盤校正方法，包括如下步驟: 運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角； 通過置于底板中的加速度計采集得到加速度信息； 獲取存儲的校正參數(shù)，分別根據(jù)所述相對傾角、加速度信息以及校正參數(shù)得到所述相對傾角所在的面對應的航向角； 處理所述計算得到的相對傾角所在的面對應的航向角，得到所述電子羅盤的航向角。
2.根據(jù)權利要求1所述的電子羅盤校正方法，其特征在于，所述獲取存儲的校正參數(shù)，分別根據(jù)所述相對傾角、加速度信息以及校正參數(shù)得到所述相對傾角所在的面對應的航向角的步驟包括: 根據(jù)所述加速度信息和所述相對傾角計算得到所述相對傾角所在的面對應的絕對傾角； 獲取存儲的校正參數(shù)； 獲取設置于所述幾何體框架的面上的傳感器所采集得到的磁力數(shù)據(jù)，根據(jù)所述校正參數(shù)對所述磁力數(shù)據(jù)進行校正，并通過所述校正后的磁力數(shù)據(jù)和絕對傾角計算得到所述相對傾角所在的面對應的航向角。
3.根據(jù)權利要求1所述的電子羅盤校正方法，其特征在于，所述處理所述計算得到的相對傾角所在的面對應的航向角，得到所述電子羅盤的航向角的步驟包括: 從所述計算得到的航向角中，按照從小到大的順序提取預設數(shù)量的航向角讀數(shù)，對所述提取的航向角讀數(shù)取平均值，并將所述平均值設置為所述電子羅盤的航向角。
4.根據(jù)權利要求1所述的電子羅盤校正方法，其特征在于，所述獲取存儲的校正參數(shù)的步驟之前還包括: 對所述電子羅盤進行三維球面旋轉； 通過設置于所述幾何體框架的面上的傳感器采集所述電子羅盤進行三維球面旋轉產生的磁力數(shù)據(jù)； 對所述采集得到的磁力數(shù)據(jù)通過橢球法處理得到校正參數(shù)，并存儲所述校正參數(shù)。
5.一種電子羅盤校正裝置，其特征在于，包括: 相對傾角運算模塊，用于運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角； 加速度計，設置于底板中，用于采集加速度信息； 第一處理模塊，用于獲取存儲的校正參數(shù)，分別根據(jù)所述相對傾角、加速度信息以及校正參數(shù)得到所述相對傾角所在的面對應的航向角； 第二處理模塊，用于處理所述計算得到的相對傾角所在的面對應的航向角，得到所述電子羅盤的航向角。
6.根據(jù)權利要求5所述的電子羅盤校正裝置，其特征在于，所述第一處理模塊包括: 絕對傾角計算單元，用于根據(jù)所述加速度信息和所述相對傾角計算得到所述相對傾角所在的面對應的絕對傾角； 參數(shù)獲取單元，用于獲取存儲的校正參數(shù)； 航向角計算單元，用于獲取設置于所述幾何體框架的面上的傳感器所采集得到的磁力數(shù)據(jù)，根據(jù)所述校正參數(shù)對所述磁力數(shù)據(jù)進行校正，并通過所述校正后的磁力數(shù)據(jù)和絕對傾角計算得到所述相對傾角所在的面對應的航向角。
7.根據(jù)權利要求5所述的電子羅盤校正裝置，其特征在于，所述第二處理模塊還用于從所述計算得到的航向角中，按照從小到大的順序提取預設數(shù)量的航向角讀數(shù)，對所述提取的航向角讀數(shù)取平均值，并將所述平均值設置為所述電子羅盤的航向角。
8.根據(jù)權利要求5所述的電子羅盤校正裝置，其特征在于，所述裝置還包括: 旋轉模塊，用于對所述電子羅盤進行三維球面旋轉； 傳感器，設置于所述幾何體框架的面上，用于采集所述電子羅盤進行三維球面旋轉產生的磁力數(shù)據(jù)； 橢球法處理模塊，用于對所述采集得到的磁力數(shù)據(jù)通過橢球法處理得到校正參數(shù)，并存儲所述校正參數(shù)。
9.一種電子羅盤校正設備，其特征在于，包括底盤裝置、加速度計和控制模塊； 所述底盤裝置包括底板和安裝于底板上的幾何體框架； 所述控制模塊用于運算所述幾何體框架上的面相對于底板的相對傾角； 所述加速度計設置于所述底板中，用于采集加速度信息； 所述控制模塊還用于獲取存儲的校正參數(shù)，分別根據(jù)所述相對傾角、加速度信息以及校正參數(shù)得到所述相對傾角所在的面對應的航向角，處理所述計算得到的相對傾角所在的面對應的航向角，得到電子羅盤的航向角。
10.根據(jù)權利要求9所述的電 子羅盤校正設備，其特征在于，所述設備還包括多個傳感器，所述傳感器分別安裝于幾何體框架的面上，用于采集所述電子羅盤進行三維球面旋轉產生的磁力數(shù)據(jù)； 所述控制模塊還用于對所述采集得到的磁力數(shù)據(jù)通過橢球法處理得到校正參數(shù)，并存儲所述校正參數(shù)。
全文摘要
本發(fā)明提供了一種電子羅盤校正方法、裝置及設備。所述方法包括運算設置于底盤裝置中幾何體框架上的面相對于底盤裝置的底板的相對傾角；通過置于底板中的加速度計采集得到加速度信息；獲取存儲的校正參數(shù)，分別根據(jù)所述相對傾角、加速度信息以及校正參數(shù)得到所述相對傾角所在的面對應的航向角；處理所述計算得到的相對傾角所在的面對應的航向角，得到所述電子羅盤的航向角。采用本發(fā)明能提高電子羅盤精度。
文檔編號G01C17/38GK103175520SQ20131009032
公開日2013年6月26日 申請日期2013年3月20日 優(yōu)先權日2013年3月20日
發(fā)明者譚光, 謝波, 毛成華, 魯鳴鳴 申請人:中國科學院深圳先進技術研究院