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