基于CP-132UL V2的IMU地面測(cè)試軟件設(shè)計(jì)

在測(cè)試過(guò)程中，如果某個(gè)位置數(shù)據(jù)不夠理想，可重新測(cè)定，也可在完成所有位置測(cè)試后，重新測(cè)定某個(gè)或幾個(gè)位置。所以在程序設(shè)計(jì)中，需要增加允許糾錯(cuò)補(bǔ)錯(cuò)功能，為每個(gè)位置設(shè)定其標(biāo)志符，并且確定每個(gè)位置數(shù)據(jù)存入的數(shù)組位置，這樣重新測(cè)定某個(gè)位置后，新數(shù)據(jù)覆蓋舊數(shù)據(jù)，從而實(shí)現(xiàn)糾錯(cuò)補(bǔ)錯(cuò)功能。由于前面每個(gè)位置的數(shù)據(jù)都固定位置，所以處理數(shù)據(jù)時(shí)只需到已確定的位置讀取數(shù)據(jù)即可。
4．3．2 陀螺標(biāo)度因數(shù)與安裝誤差系數(shù)的標(biāo)定
采用速率標(biāo)定方法來(lái)標(biāo)定陀螺標(biāo)度因數(shù)和安裝誤差系數(shù)。按X、Y、Z軸標(biāo)定，允許糾錯(cuò)或補(bǔ)錯(cuò)。在單軸轉(zhuǎn)臺(tái)，利用轉(zhuǎn)臺(tái)的正反轉(zhuǎn)相互抵消地球角速度的影響。為了減小轉(zhuǎn)臺(tái)不水平的影響，采用提高轉(zhuǎn)速的方法，以高于30°／s的轉(zhuǎn)速來(lái)實(shí)現(xiàn)，由于地球自轉(zhuǎn)角速率相對(duì)于轉(zhuǎn)臺(tái)轉(zhuǎn)速來(lái)說(shuō)很?。虼藢⑥D(zhuǎn)臺(tái)近似視為繞慣性空間轉(zhuǎn)動(dòng)。為了避免動(dòng)態(tài)效應(yīng)．轉(zhuǎn)臺(tái)的旋轉(zhuǎn)啟動(dòng)和停止均不包括在測(cè)試時(shí)間之內(nèi)。為提高試驗(yàn)精度，采用整圈標(biāo)定法，其轉(zhuǎn)動(dòng)時(shí)間為120 s，轉(zhuǎn)數(shù)為10圈。
4．3．3 陀螺零位的標(biāo)定
取天北西，天南東，地南西，地北東4個(gè)位置，每個(gè)位置靜態(tài)測(cè)試時(shí)間約20 min。設(shè)置4個(gè)標(biāo)志位分別對(duì)應(yīng)4個(gè)位置，然后將4個(gè)位置的數(shù)據(jù)分別存入內(nèi)存數(shù)組中。將存入內(nèi)存數(shù)組中的4個(gè)位置的數(shù)據(jù)分別帶入(1)式得到陀螺零位。陀螺零位為4個(gè)位置陀螺輸出的算術(shù)平均值(Dx0)。

4．3．4 程序設(shè)計(jì)流程
標(biāo)定測(cè)試共分為3步：①位置標(biāo)定，完成對(duì)加速度計(jì)的標(biāo)定；②速率標(biāo)定，標(biāo)定陀螺的安裝誤差和標(biāo)度因數(shù)；(9陀螺常值標(biāo)定。圖4為總程序設(shè)計(jì)流程。按照?qǐng)D4的流程，設(shè)計(jì)圖5所示的測(cè)試軟件。設(shè)計(jì)中首先判斷功能．選擇所需的功能，只需設(shè)置3個(gè)標(biāo)志符，每個(gè)標(biāo)志符對(duì)應(yīng)相應(yīng)的功能。具體測(cè)試功能中，建立3個(gè)類，各個(gè)類編寫各自的測(cè)試功能。位置標(biāo)定時(shí)，由于位置比較多，對(duì)每一個(gè)位置都應(yīng)設(shè)置各自的標(biāo)志符，采集到的數(shù)據(jù)存儲(chǔ)在內(nèi)存中固定位置。這樣處理數(shù)據(jù)時(shí)只需讀取相應(yīng)位置，避免誤操作，縮短操作時(shí)間。在速率標(biāo)定時(shí)，設(shè)置3個(gè)全局變量分別表示3個(gè)軸，同時(shí)在補(bǔ)測(cè)時(shí)，可直接將舊數(shù)據(jù)覆蓋新數(shù)據(jù)。陀螺零位測(cè)試時(shí)，由于測(cè)試時(shí)間較長(zhǎng)，在測(cè)試初始化中需占用的數(shù)組存儲(chǔ)空間較大，數(shù)據(jù)處理部分和位置標(biāo)定差不多。圖5是測(cè)試界面。

5 結(jié)果評(píng)估
將IMU組合置于平板上，利用所測(cè)得的陀螺和加表的各項(xiàng)誤差系數(shù)，根據(jù)陀螺和加表的誤差方程，求得此時(shí)陀螺和加表在標(biāo)得的誤差系數(shù)下的輸入，即陀螺各軸敏感的地球自轉(zhuǎn)角速度和加表各軸敏感的重力加速度，然后與理想的地球自轉(zhuǎn)角速度及重力加速度相比較，評(píng)估標(biāo)定結(jié)果。如果相差在陀螺和加表的精度允許范圍內(nèi)，說(shuō)明標(biāo)定結(jié)果比較滿意。

6 結(jié)語(yǔ)
CP一132UL V2一端接IMU組合，另一端直接插入工控機(jī)，采用VC6．0編寫滿足測(cè)試方案的測(cè)試軟件。經(jīng)工程測(cè)試證明，測(cè)試軟件與CP一132UL V2兼容性好，在高波特率下工作穩(wěn)定，順利完成IMU的地面測(cè)試。