基于MCU的室外移動(dòng)機器人組合導航定位系統

　　對于在室外環(huán)境工作的移動(dòng)機器人通常使用慣導/衛星組合導航方式。慣性導航系統[1]具有完全自主、抗干擾強、隱蔽能力好和輸出參數全面等優(yōu)點(diǎn)，但它的魯棒性極低，誤差會(huì )不斷隨時(shí)間累積發(fā)散。衛星導航系統具有精度高、定位范圍廣和誤差不隨時(shí)間累積等優(yōu)點(diǎn)，但其自主性差、易受外界遮擋和干擾、接收機數據更新頻率低等缺點(diǎn)。因此工程上常常將兩者互補結合使用，組成衛星/慣性組合導航系統。

　　本文以低功耗MSP430F149為核心，設計了能夠同時(shí)實(shí)現衛星導航(GNSS)接收機、慣性測量單元(IMU)、氣壓高度等導航信息的高速采集與高速合路傳輸，并進(jìn)行初步導航定位信息融合的導航系統，即可為室外移動(dòng)機器人提供直接的導航服務(wù)，也可作為高精度組合導航系統的原始測量信息高速采集系統。

　　系統設計的關(guān)鍵是利用單片機有限的接口資源實(shí)現了多傳感器信息并行采集，設計了有效的數據同步方法，解決了氣壓傳感器數據手冊疏漏導致的無(wú)法接入問(wèn)題，給出了機器人組合定位的基本方法。系統充分利用了MSP430F149單片機的能力，具有結構簡(jiǎn)單、低功耗、對傳感器具有普適性等優(yōu)點(diǎn)。

　　1總體設計

　　本系統由電源、氣壓計接口、IMU接口、GNSS接收機接口、SPI轉UART模塊及MSP430F149構成。系統組成如圖1所示。

　　組合導航系統的功能實(shí)現分為IMU數據接收與解析、GNSS數據接收與解析、氣壓計數據接收與解析、組合導航解算以及數據輸出五個(gè)部分。IMU數據接收與解析功能用來(lái)獲取導航解算中需要的加速度和角速度信息;GNSS數據接收與解析功能用來(lái)獲取導航解算中需要的位置和速度信息(松耦合組合)或者GNSS偽距和偽距率(緊耦合組合);氣壓計數據接收與解析功能用來(lái)獲取高度信息;組合導航解算功能為系統核心，用來(lái)進(jìn)行組合導航解算;數據的輸出包括原始數據包的整合輸出和解算結果的輸出。

　　圖1系統組成結構圖

　　本文所使用的慣性器件和GNSS接收機都是RS-232電平的UART接口，具有通用性，用戶(hù)可根據成本考慮不同精度的設備。氣壓計選用美國MEAS公司生產(chǎn)的MS5803-02BA，已經(jīng)固化在電路中。

　　2硬件電路設計

　　2.1微控制器接口

　　整個(gè)組合導航定位系統需要三個(gè)UART接口和兩個(gè)SPI接口。其中兩個(gè)UART接口由430單片機自帶的UART資源提供，另外一個(gè)UART接口由GPIO模擬SPI通過(guò)MAX3111E芯片轉化得到;兩個(gè)SPI接口由GPIO模擬得到。另外需要一個(gè)外部中斷引腳捕獲秒脈沖信號(PPS)、一個(gè)外部中斷引腳捕獲MAX3111E中斷信號。MSP430F149管腳資源分配如表1所示。

　　2.2電源電路

　　本系統供電需求為3.3V供電，因此采用AMS1117穩壓芯片，接入5V電源即可輸出3.3V穩定電壓，可提供1A電流，滿(mǎn)足系統供電需求。電路設計如圖2所示。

　　圖2電源電路

　　2.3 IMU器件及GNSS接收機接口電路

　　IMU器件及GNSS接收機都采用UART接口方式接入，采用RS232協(xié)議。因此可使用430單片機上自帶的兩個(gè)UART接口，但是需要進(jìn)行TTL電平與RS232電平轉換。這里采用常見(jiàn)的MAX3232芯片，電路設計如圖3所示。

　　圖3 IMU及GNSS接口電路

　　2.4氣壓計MS5803-02BA接口電路

　　MS5803-02BA[3]是由MEAS公司生產(chǎn)的數字壓力傳感器，分辨率達10cm.芯片內部包含一個(gè)高線(xiàn)性的壓力傳感器和一個(gè)內部工廠(chǎng)標定系數的超低功耗24位ΔΣ型ADC.該款芯片有SPI和I2C兩種接口方式，通過(guò)芯片的PS引腳配置了選擇不同的接口方式(PS置低時(shí)，采用SPI工作模式;PS置高時(shí)，采用I2C工作模式)。本文所闡述的定位系統將氣壓計配置為SPI工作模式。MS5803-02BA與微控制器間的接口電路設計如圖4所示。

　　圖4 MS5803-02BA接口電路

　　MS5803-02BA的控制命令包括復位命令、溫度ADC命令、氣壓ADC命令、ADC讀取命令、PROM讀取命令?？刂泼钊绫?所示。

　　控制命令通過(guò)SDI口移位輸入，響應結果從SDO移位輸出。輸入的電平判定在時(shí)鐘信號的上升沿，輸出的電平判定在時(shí)鐘信號的下降沿。輸出的氣壓值可以進(jìn)行溫度補償，需要利用芯片內部PROM中的系數來(lái)補償。ADC讀取命令輸入之后，輸出24位ADC結果;PROM讀取命令輸入之后，輸出16位補償系數。

　　下面是讀取ADC的C語(yǔ)言代碼：

　　CSN_OFF_MS();//CS置低

　　SPI_WRITE_8BIT(CMD);//SDI移入8位CMD

　　delay_ms(10); //延時(shí)10ms

　　CSN_ON_MS();//CS置高

　　CSN_OFF_MS();//CS置低

　　SPI_WRITE_8BIT(0x00);//SDI移入8位0x00

　　result = SPI_READ_24BIT();//SDO移出24位

　　CSN_ON_MS();//CS置高

　　下面是讀取PROM的C語(yǔ)言代碼：

　　CSN_OFF_MS();//CS置低

　　SPI_WRITE_8BIT(CMD); //SDI移入8位CMD

　　result=SPI_READ_16BIT();//SDO移出24位

　　CSN_ON_MS();//CS置高

　　結合器件的使用手冊及手冊疏漏的地方，使用MS5803-02BA時(shí)需要注意：

　　1、溫度和氣壓ADC命令發(fā)送之后，芯片內部需要一定的時(shí)間進(jìn)行采樣轉換，具體時(shí)間與過(guò)采樣率(OSR)有關(guān)，最大需求時(shí)間為10ms，因此本文采用的延時(shí)時(shí)間為10ms;

　　2、片選信號CS的下降沿到時(shí)鐘SCLK信號的第一個(gè)上升沿至少要有21ns的時(shí)間延遲，否則命令無(wú)法正確寫(xiě)入芯片;

　　3、8位的ADC讀取命令之后，必須保持CS片選信號持續為低，再產(chǎn)生24位時(shí)鐘信號輸入，將24位的ADC結果讀取出來(lái)(即一個(gè)命令字為8位，但實(shí)際需要32個(gè)連續的時(shí)鐘周期才能完整讀取ADC結果);

　　4、對于PROM讀取命令同ADC讀取命令，一共需要24個(gè)連續的時(shí)鐘周期完成，其中8位命令字輸入，16位數據讀出。

　　5、對于所有從SDO移位輸出數據的同時(shí)，都需要SDI輸入端保持低電平。