- 基于MSP430的車體自動調(diào)平系統(tǒng)的學習
- 車體調(diào)平裝置總體設計
- 車體調(diào)平裝置機殼采用鋁合金整體加工
- 調(diào)平裝置將傳感器、數(shù)據(jù)模塊和無線數(shù)傳技術(shù)結(jié)合在一起
隨著國防技術(shù)的發(fā)展,根據(jù)任務需求,越來越多的軍用武器需要隨時變更工作地點。為了保證這些軍用武器的機動性能,往往以載車為運輸載體,如火箭炮這樣的大型武器就被安裝在載車上。載車到達目的地后,借助平臺快速將武器架設調(diào)至水平而后工作,工作完成后平臺能夠快速地撤收、轉(zhuǎn)移。既保證了武器的工作性能,又提高了機動性。
傳統(tǒng)上,主要依靠人工手動完成平臺的水平度調(diào)節(jié),這需要一部分人員手動調(diào)節(jié)千斤頂,另外一部分人員觀察水平儀的水泡位置。這種調(diào)平方式費時費力,且精度低、抗傾覆能力差。隨著調(diào)平時間和調(diào)平精度要求的提高,過去的調(diào)平方式已遠遠不能滿足實際情況的需要,所需時間短、精度高、抗傾覆能力強的自動調(diào)平控制技術(shù)應運而生。
在軍用方面,自動調(diào)平控制系統(tǒng)廣泛應用于機動發(fā)射裝置、導彈車、坦克火控調(diào)試臺等裝備。以火箭炮為例,火箭炮被大量使用在高科技戰(zhàn)爭中,為了提高其生存能力,對其機動性能也提出了更高的要求。制約火箭炮機動性的主要因素是火箭炮進入陣地后,進行架設并調(diào)整到水平狀態(tài)的時間。自動調(diào)平裝置是消除這一制約因素的關鍵設備。隨著電子元器件和自動控制技術(shù)的發(fā)展,自動調(diào)平裝置采用了許多新器件、新方法,使得調(diào)平時間和調(diào)平精度嚴格符合戰(zhàn)場要求。
設計火箭炮車體調(diào)平裝置的目的是使火箭炮在停車工作時其載車能夠迅速架設,實現(xiàn)武器系統(tǒng)平臺傾斜度的快速測量、計算和無線數(shù)傳,使其快速精確地達到水平,即在保證火箭炮工作性能的條件下最大程度的提高系統(tǒng)的機動性。
自動調(diào)平系統(tǒng)發(fā)展趨勢概述
目前,調(diào)平技術(shù)都已逐步成熟,但隨著武器機動性要求的不斷提高,也相應提高了對調(diào)平時間和調(diào)平精度的要求,與之相適應的自動控制調(diào)平技術(shù)也不斷發(fā)展。自動調(diào)平系統(tǒng)的發(fā)展方向主要是:
(1)精確性:系統(tǒng)的精確性主要取決于傾角傳感器的分辨率。隨著新結(jié)構(gòu)、新材料、新工藝和新技術(shù)在高精度傾角傳感器中的應用,傾角傳感器的性能大幅度地提高了,傾角傳感器正從傳統(tǒng)的液體擺、氣體擺原理向伺服加速度及力平衡、重力擺原理發(fā)展,傾角傳感器的分辨率已達到0.001度或更高。
(2)穩(wěn)定性:為了適應現(xiàn)代武器高機動性和快速反應能力的需求,要求車載平臺有更高的穩(wěn)定性,采用機電伺服系統(tǒng)代替電液伺服系統(tǒng),加上單片機系統(tǒng)可靠性與抗干擾技術(shù)的不斷發(fā)展,奠定了單片機系統(tǒng)穩(wěn)定可靠工作的基礎。尤其是計算機與傳感器技術(shù)的發(fā)展,使高穩(wěn)定性的調(diào)平系統(tǒng)得以實現(xiàn)。
(3)快速性:目前,傾角傳感器的響應速度已顯著提高,新型傾角傳感器響應時間達到了5毫秒,響應速度為200次/秒,再加上在系統(tǒng)中應用先進控制算法,都使得調(diào)平系統(tǒng)的調(diào)平時間大大縮短了,也就提高了武器系統(tǒng)的快速性。
(4)可操作性:在自動調(diào)平系統(tǒng)中設計有人機交互顯示面板,通過其圖形界面顯示系統(tǒng)的狀態(tài)及各種實時參數(shù),并根據(jù)工作需要對系統(tǒng)進行參數(shù)設置。面板設置有多個功能鍵,可根據(jù)需要自由定義,實現(xiàn)調(diào)平系統(tǒng)的各種操作。這些都將使系統(tǒng)的可操作性得到大大提高。
[page]
車體調(diào)平裝置總體設計
火箭炮車體調(diào)平裝置總體設計包括:傾角傳感器的選型、數(shù)據(jù)處理與無線數(shù)傳電路設計。車體調(diào)平裝置機殼采用鋁合金整體加工,內(nèi)置傾角傳感器、電路板、電池和無線發(fā)射模塊等,水平檢查座與機殼由螺釘固連,采用優(yōu)質(zhì)合金鋼,表面光潔度和水平度優(yōu)于水準儀標準,發(fā)射機天線位于機殼的上方,使用時旋擰上,裝箱時可以折疊放倒或旋擰下。車體調(diào)平裝置控制原理如圖1所示。
圖1 車體調(diào)平裝置控制原理圖
傾角傳感器及傳感器包數(shù)據(jù)輸出格式
傾角傳感器選型
傾角傳感器用于感應火箭炮車體的縱橫向傾斜度,基本技術(shù)要求:①精度高于±0.012°;②使用環(huán)境溫度為﹣40℃~﹢55℃。根據(jù)這些要求,選用北京星網(wǎng)宇達科技公司的TW-TS1110傾角傳感器。該傳感器內(nèi)部采用高速數(shù)字處理器,對多維重力加速度信息進行處理與姿態(tài)角解算,并采用角度數(shù)字輸出模式,輸出速度為5Hz,測量范圍為±15°。測量精度:當傾角≤±5°時,精度為±0.005°;當傾角≤±15°時,精度為±0.01°;當傾角≤±30°時,精度為±0.035°。傳感器利用光刻電阻技術(shù)補償非線性誤差,解決了傳統(tǒng)傾角傳感器只有在小范圍才能保證精度的現(xiàn)象,使得傾角傳感器在全測量范圍內(nèi)線性化,保持同一額定精度指標。傳感器還采用啟動零位測試補償技術(shù),具有快速穩(wěn)定輸出能力,單點重復性為0.0015°;采用動態(tài)數(shù)字濾波技術(shù),輸出噪聲低,且具有較高的分辨率,分辨率為0.002°,傳感器內(nèi)部采用動態(tài)零位與標度因數(shù)自校正技術(shù)。適合多種環(huán)境使用,使用環(huán)境溫度為﹣40℃~﹢55℃。
傳感器包數(shù)據(jù)輸出格式
1 發(fā)送數(shù)據(jù)格式定義
①ASCII碼發(fā)送格式(單角度):24 FF XX XX XX XX XX 0D 0A
說明——24:頭標識$;FF:角度值的符號位(+2b/-2d);XX:ASCII碼角度值(30~39);0D 0A:角度發(fā)送字尾標識符(換行,回車)。
②二進制碼發(fā)送格式(單角度):AA XX XX CC
AA:角度發(fā)送字頭標識符;XX:帶符號二進制數(shù)。5度傾角標度:6000bit/度;15度傾角標度:2000bit/度;30度傾角標度:1000bit/度;60度傾角標度:500bit/度。
CC:校驗碼;CC=數(shù)據(jù)字節(jié)1+數(shù)據(jù)字節(jié)2。
2 接受命令格式定義
讀角度命令格式如圖2所示。該命令僅在應答工作模式下有效。每個傳感器都有固定ID字(FFFF)和用戶ID字(用戶可設定,初始為0000),2個ID字都可讀角度。
圖2 讀角度命令格式
數(shù)據(jù)處理與無線數(shù)傳電路設計
無線數(shù)傳系統(tǒng)是無線數(shù)字傳輸系統(tǒng)的簡稱,該系統(tǒng)以無線數(shù)傳模塊為平臺,在不影響裝備功能情況下,實現(xiàn)數(shù)字終端之間數(shù)字信息的無線傳輸。數(shù)據(jù)處理與無線數(shù)傳的主要任務是接收傾角傳感器的數(shù)據(jù)輸出,計算每個千斤頂相對車體水平面所要調(diào)整的角度,并通過無線數(shù)傳模塊傳輸給操縱指示器。
MSP430F149單片機簡介
單片機具有可靠性高、功耗低、擴展靈活、體積小、價格低和使用方便等優(yōu)點,廣泛應用于儀器儀表、專用設備智能化管理及過程控制等領域,有效地提高了控制質(zhì)量與經(jīng)濟效益。本設計選用TI公司的16位超低功耗混合型微處理器MSP430F149(見圖3)作為核心控制器,它的主要特點是:
(1)低電壓、超低功耗
該單片機的電源電壓采用1.8V~3.6V低電壓,RAM數(shù)據(jù)保持方式下耗電僅0.1μA,在2.2V、1MHz主頻的活動模式時工作電流為280μA,I/O輸入端口的漏電流最大僅50nA。
[page]
(2)強大的處理能力
該單片機為16位的精簡指令集(RISC)結(jié)構(gòu),具有豐富的尋址方式(7種源操作數(shù)尋址、4種目的操作數(shù)尋址)、簡潔的27條內(nèi)核指令以及大量的模擬指令;大量的寄存器以及片內(nèi)數(shù)據(jù)存儲器都可參加多種運算,還有高效的查表處理方法及較高的處理速度,一個時鐘周期可以執(zhí)行一條指令,使單片機在8MHz晶振工作時,指令速度可達8MIPS。
(3)豐富的片上外圍模塊
該單片機集成了較豐富的片內(nèi)外設:模擬比較器A、定時器A、定時器B、串行通信接口USART0和USART1、硬件乘法器、12位ADC、端口1~6、看門狗等。
(4)系統(tǒng)工作穩(wěn)定
該單片機在上電復位后,首先由DCOCLK啟動CPU,保證程序從正確的位置開始執(zhí)行,同時也保證了晶體振蕩器有足夠的起振和穩(wěn)定時間;之后通過軟件可設置適當?shù)募拇嫫鞯目刂莆粊泶_定最后的系統(tǒng)時鐘頻率。在CPU運行中,如果MCLK發(fā)生故障,DCO會自動啟動,以確保系統(tǒng)正常工作。如果程序跑飛,可以用看門狗將其復位。
(5)方便高效的開發(fā)環(huán)境
MSP430F149片內(nèi)有JTAG調(diào)試接口,還有可電擦寫的FLASH存儲器,因此采用先通過JTAG接口下載程序到FLASH內(nèi),再由JTAG接口控制程序運行、讀取片內(nèi)CPU狀態(tài),以及存儲器內(nèi)容等信息供設計者調(diào)試。由于單片機可支持串行在線編程,使開發(fā)變得更加簡便,并且開發(fā)的仿真器價格低廉,不需要昂貴的編程器。
無線數(shù)傳電路的設計
數(shù)據(jù)處理與無線數(shù)傳電路設計主要包括主控制器電路、傾角傳感器接口電路、無線數(shù)傳模塊接口電路、電源電路等?;竟ぷ髟硎牵合到y(tǒng)通上電后,主控制器控制傾角傳感器按固定間隔檢測火箭炮車體姿態(tài),將接收到的檢測結(jié)果運算處理,計算每個千斤頂?shù)恼{(diào)整量,再通過無線數(shù)傳模塊發(fā)送給操縱指示器。
(1)主控制器及接口電路設計
主控器采用MSP430F149單片機,串口1經(jīng)TTL-RS232電平轉(zhuǎn)換接傾角傳感器,用于接收傳感器輸出數(shù)據(jù),串口2 TTL電平接無線數(shù)傳模塊,發(fā)送車體縱橫向傾斜角度和調(diào)整角度至操縱指示器。主控制器及接口電路如圖3所示。
圖3 主控器及接口電路圖
(2)電源電路設計
電源采用12V/1000mAh的鋰電池,直接為傾角傳感器供電,再經(jīng)兩路DC-DC轉(zhuǎn)換,分別轉(zhuǎn)換至9V和3.3V,9V電源為無線數(shù)傳模塊供電,3.3V為主控制器及接口電路供電,充電電路采用LM317芯片,恒流方式充電。電源電路見圖4所示。
(3)無線數(shù)傳模塊的選用
在一些多測試點的系統(tǒng)中,伴隨傳感器而來的是大量數(shù)據(jù)線纜。眾多的線纜不僅帶來布線的復雜不便,而且存在著短路、短線隱患,成本高,易老化,還給系統(tǒng)的調(diào)試和維護增加了難度。另外,在一些特殊的應用場合,需要將傳感器放置在有危險的封閉環(huán)境中進行工作,試圖通過連線的方法得到傳感器的信號顯然是有一定難度的。而采用無線方式來實現(xiàn)信號的傳送,可以解決這一問題。相比有線傳輸,無線傳輸具有不占據(jù)空間、沒有布線要求、成本低、可靠性高、維護方便及傳輸中的干擾較少等優(yōu)點,這也在一定程度上提高了傳輸?shù)目煽啃浴?
圖4 電源電路圖
根據(jù)實際情況,本文采用ZT-TR43F無線數(shù)傳模塊,它是一款無線收發(fā)一體的低功耗通信模塊。該模塊的技術(shù)指標如下:①載波頻率為433MHz,工作頻率為428MHz~435MHz;②最大發(fā)射功率5mW,接收靈敏度﹣105dBm;③采用FSK調(diào)制,采用前向信道糾錯編碼,抗干擾能力強;④有八個工作信道可供選擇;⑤傳輸速率9.6kbps;⑥降低噪聲放大器LNA、功率放大器PA、壓空振蕩器VCO等大部分功能集成在芯片內(nèi),外圍電路簡單易于開發(fā)。采用該無線數(shù)傳模塊,可以使車體調(diào)平裝置滿足某型火箭炮調(diào)平時的無線數(shù)傳要求:①適當?shù)耐ㄐ啪嚯x,一般以不超過30m為宜,通信功率過大使通信距離過遠,會造成炮與炮之間相互干擾;②較強的抗干擾能力,系統(tǒng)在較強的外界干擾中也能正常工作;③較低的功耗,該裝置野外應用,無固定供電電源,只能靠電池維持系統(tǒng)運行。
[page]
無線模塊ZT-TR43F與單片機接口提供了RS232/TTL/RS485三種接口方式,本系統(tǒng)采用TTL接口方式,方便與MSP430F149單片機的接口。其中MSP430單片機的RXD、TXD口分別與無線模塊的TXD、RXD口相接,地線與地線相接。
考慮到多門火箭炮同時調(diào)平時,有多個調(diào)平裝置同時工作,為防止之間相互干擾,采取不同的通信信道或不同編碼方式識別,每個裝置上帶有撥碼盤,通過撥碼盤設置各自的通信信道或識別碼。
調(diào)整角度的計算
主控制器接收到車體的縱橫向傾斜角度后,需要計算每個千斤頂相對調(diào)整的角度,角度計算的幾何關系見圖5。
圖5 角度計算關系圖
如圖5所示,車體水平傾斜角度可反映在橫向和縱向兩個方向,圖5中a和b分別為橫向和縱向傾斜角度,設α和β為傾角傳感器得出的橫向和縱向角度。若α大于0,則A端千斤頂打高,B端千斤頂打低。兩端千斤頂各位移約為α/2乘以AB端點間隔的一半的距離,然后調(diào)整千斤頂直到橫向水準氣泡居中。若β大于0,則A端和B端同時打低,若β小于0,則A端和B端同時打高。打高過程中調(diào)整千斤頂直到縱向水準氣泡居中。
軟件設計
(1)軟件功能
軟件功能主要有:①檢測操縱指示器連接狀態(tài);②連續(xù)讀取縱橫向傾斜角度并求平均值;③將角度值發(fā)送給操縱指示器。
(2)開發(fā)平臺
軟件開發(fā)選擇與裝置硬件中單片機相適應的IAR開發(fā)平臺,使用C語言開發(fā)。
(3)軟件流程
調(diào)平軟件完成讀取縱向與橫向傾斜角度值、模擬顯示水準氣泡指示、計算并顯示左右千斤頂調(diào)整方向等功能,其工作流程如圖6所示,其中單片機讀取角度數(shù)據(jù)的流程如圖7所示。車體調(diào)平裝置端程序通過串口讀取到傾角傳感器的縱、向傾斜角度值,根據(jù)角度值分別計算出左、右千斤頂?shù)恼{(diào)整方向和模擬水準氣泡的中心位置坐標,然后將這些值通過串行通信分別發(fā)送到左、右操縱指示器上。
圖6 車體調(diào)平裝置軟件流程圖
圖7 讀取角度數(shù)據(jù)流程圖
結(jié)束語
高精度調(diào)平裝置主要用于車載火箭炮平臺和導彈發(fā)射平臺等,本文針對傳統(tǒng)車載平臺依靠人工手動調(diào)整平臺水平,從而導致調(diào)整時間長、精度低,進而限制影響到火箭炮等武器的機動性和快速反應能力,提出了個人的觀點和設計。本文基于MSP430F149單片機,對某型火箭炮車體調(diào)平裝置的控制原理和結(jié)構(gòu)設計進行了闡述。該調(diào)平裝置將傳感器、數(shù)據(jù)模塊和無線數(shù)傳技術(shù)有機地結(jié)合在一起,可實現(xiàn)車體傾斜度的自動快速檢測、計算和傳輸。該裝置具有檢測迅速、控制靈活和操作簡單等優(yōu)點,能有效提高某型火箭炮的機動性和調(diào)平精度。