時間:2008-11-25 10:56:00來源:ronggang
圖2 實物和引腳分布圖[/align]
3.系統(tǒng)軟件設(shè)計
3.1 系統(tǒng)軟件設(shè)計流程
每個MS5534B在出廠時都有一個針對模塊特有的四個Word校準(zhǔn)數(shù)據(jù),儲存在64位的PROM中。ARM7微處理器在初始化以后通過串口從MS5534B中讀出Word1~Word4,然后運用邏輯移位操作方式轉(zhuǎn)化為6個校準(zhǔn)補償系數(shù)C1~C6。ARM7微處理器從MS5534B不斷讀取絕對氣壓值D1和溫度值D2,然后結(jié)合校準(zhǔn)補償系數(shù)計算求得相對氣壓值P,判斷其是否在有效范圍內(nèi),對有效值進(jìn)行低通濾波處理,最后按折線法轉(zhuǎn)化為海拔高度值。將高度值通過與飛控系統(tǒng)相連接的無線數(shù)據(jù)傳輸模塊實時傳輸?shù)降孛嬲?,實時掌握飛機的飛行高度,對出現(xiàn)的意外情況可以及時處理[5]?;贛S5534B的高度測量系統(tǒng)的軟件流程圖3如下所示。
[align=center]
圖3 系統(tǒng)工作流程圖[/align]
3.2 折線線性擬合法將氣壓值轉(zhuǎn)化為高度值
在實際應(yīng)用中,大氣壓力與海拔高度的關(guān)系是非線性的[6],傳統(tǒng)的方法是將氣壓值與對應(yīng)的高度值做成數(shù)據(jù)表,運用查表的方式,如果精確到1m,則需要上萬個數(shù)據(jù),需要龐大的存儲空間,且耗時較大,另外由于飛控系統(tǒng)中微處理器對大量浮點運算的能力不是很強,并且飛控系統(tǒng)對實時性要求很高,為了節(jié)省寶貴的存儲空間,所以本系統(tǒng)設(shè)計運用折線法進(jìn)行線性擬合[7]。折線線性擬合法的基本思想就是將被逼近的函數(shù)曲線根據(jù)變化情況分成多個間隔區(qū)域值,為了提高精度及縮短運算時間,各間隔域值內(nèi)可根據(jù)精度要求,采用不同的斜率線性線段表示曲線線段。擬合原理誤差分析如圖4所示。
[align=center]
圖4 擬合原理誤差分析圖[/align]
根據(jù)大量實驗數(shù)據(jù)和理論推導(dǎo)得擬合公式(1)
圖5 折線法擬合曲線效果圖[/align]
為了進(jìn)一步提高精度,可以采用非等距分段法,根據(jù)函數(shù)曲線形狀的變化率的大小來修正間隔點間的距離。曲率變化大的部分,距離取小一點,而在曲線較平緩區(qū)域距離取大一點。
[align=center]
圖6 折線法與實際高度誤差分析圖[/align]
圖6為在海拔-700m~8000m時,運用Matlab仿真折線擬合法所得海拔高度與我國標(biāo)準(zhǔn)大氣壓對照高度誤差示意圖,在-700m~8000m時最大高度誤差為+/-5m,而在-100~1000m時的誤差在+/-3m以內(nèi),適合小型無人機的高度需求。
4.結(jié)論
在自行研制的無人機自動駕駛儀上,應(yīng)用了上述的基于MS5534B的氣壓高度測量系統(tǒng),在實際多次飛行任務(wù)中測試的效果良好,定位高度準(zhǔn)確。本文針對小型無人機自動駕駛儀微處理器浮點運算能力不強,實時性要求高的特點,提出折線線性擬合的方法,減少了大量浮點運算,提高了運算效率,節(jié)省了寶貴的RAM存儲空間,適合于小型無人機的自動駕駛儀中。
參考文獻(xiàn)
[1]申安玉等.自動飛行控制系統(tǒng)[M].國防工業(yè)出版社,2003:95-99.
[2]趙鵬等.基于AT91m55800的無人機飛行系統(tǒng)設(shè)計與實現(xiàn)[J].微計算機信息,2005年第21卷第4期:9-10.
[3]Using MS5534 for altimeters and barometers. http// www.intersema.ch /site/technical [EB/OL].
[4] 求是科技.單片機典型模塊設(shè)計實例導(dǎo)航[M].北京:人民郵電出版社,2005: 166-170.
[5] 胡壽松.自動控制原理[M].科學(xué)出版社,2001:241-245.
[6] 錢翼稷.空氣動力學(xué)[M].北京航空航天大學(xué)出版社.2005:247-250.
[7] 潘新民等.微型計算機控制技術(shù)[M].電子工業(yè)出版社,2005:261-263.
[8] 魏克新等.MATLAB語言與自動控制系統(tǒng)設(shè)計[M].機械工業(yè)出版社,2004:73-75.
標(biāo)簽:
傳動網(wǎng)版權(quán)與免責(zé)聲明:凡本網(wǎng)注明[來源:傳動網(wǎng)]的所有文字、圖片、音視和視頻文件,版權(quán)均為傳動網(wǎng)(www.wangxinlc.cn)獨家所有。如需轉(zhuǎn)載請與0755-82949061聯(lián)系。任何媒體、網(wǎng)站或個人轉(zhuǎn)載使用時須注明來源“傳動網(wǎng)”,違反者本網(wǎng)將追究其法律責(zé)任。
本網(wǎng)轉(zhuǎn)載并注明其他來源的稿件,均來自互聯(lián)網(wǎng)或業(yè)內(nèi)投稿人士,版權(quán)屬于原版權(quán)人。轉(zhuǎn)載請保留稿件來源及作者,禁止擅自篡改,違者自負(fù)版權(quán)法律責(zé)任。
產(chǎn)品新聞
更多>2025-11-07
2025-10-31
2025-10-22
2025-10-17
2025-10-11
2025-10-09