無人機(jī)控制PX4系統(tǒng)傳感器介紹

飛控系統(tǒng)的傳感器1.1飛控系統(tǒng)的傳感器無人飛行器要求能夠穩(wěn)定飛行，首先最基礎(chǔ)的問題是需要確定自己在空間中的位置、速度和姿態(tài)等相關(guān)的系統(tǒng)狀態(tài)。而要的到這些狀態(tài)，就需要通過不同的安裝在機(jī)身系統(tǒng)上的各種不同的傳感器。我們所處的空間是三維空間，因此主要的飛行器系統(tǒng)狀態(tài)也主要基于這個三維空間同時在時間維度進(jìn)行拓展：1：通過全球定位系統(tǒng)GNSS來定位自己的經(jīng)度、維度和高度等三維坐標(biāo)信息，同時也可以獲取這三維的速度信息2：通過陀螺儀加速度計直接獲取三軸加速度信息與旋轉(zhuǎn)角信息的狀態(tài)量，其他的狀態(tài)欄只有通過姿態(tài)解算3：當(dāng)飛行器需要往某個方向飛行時是通過調(diào)整飛行器的姿態(tài)往對應(yīng)方向傾斜，飛行器的一部分升力會分配到該方向上成為該方向的拉力。飛行器要能夠調(diào)整飛行的姿態(tài)，就必須能夠?qū)崟r的獲得機(jī)體當(dāng)前相對于慣性坐標(biāo)系的姿態(tài)，在三維空間中同樣姿態(tài)角也是由三個軸的角度來表示4：飛行器的三維空間位置信息、三維空間速度信息、三維空間角度信息以及三維空間加速度信息和三維空間的角速度信息，總共有是十五個系統(tǒng)空間狀態(tài)量需要獲得5：傳感器跟估計的精度決定了建模辨識與控制的精度，然后傳感器跟估計的精度，與建模辨識，一起決定了控制的精度。因此傳感器的采集精度與飛行控制的控制精度密切相關(guān)1.2I2C簡介光標(biāo)飛控系統(tǒng)中集成的微機(jī)械六軸傳感器和磁力計均采用I2C總線接口與主控處理器連接。本章著重介紹I2C接口總線、各傳感器的接口驅(qū)動、數(shù)據(jù)采集及處理模型。I2C(Inter—IntegratedCircuit)總線是一種由PHILIPS公司開發(fā)的兩線式串行總線，用于連接微控制器及其它的一些外圍設(shè)備。和我們常用的UART通信不同，雖然UART有TX、RX兩個接口，但是這兩根線都是可以單獨使用，I2C是由數(shù)據(jù)線SDA和時鐘SCL構(gòu)成的串行總線，可發(fā)送和接收數(shù)據(jù)。在CPU與被控IC設(shè)備之間、IC設(shè)備與IC設(shè)備之間進(jìn)行雙向傳送，高速I2C總線一般可達(dá)400kbps以上。它的特點是：通信模式為主從式設(shè)備，可以一主多從，也可以多主多從I2C總線組成“線與”的關(guān)系，任何一個器件都可以拉到低電平I2C總線上可以并連多個器件I2C總線有起始信號、數(shù)據(jù)傳輸、停止信號支持7位/10位芯片地址尋址支持不同的通信速率，標(biāo)準(zhǔn)速度為100kHz，高速速度為400kHzI2C總線在傳送數(shù)據(jù)過程中一共有三種類型的信號，它們分別是：開始信號、結(jié)束信號和應(yīng)答信號。vcc七設(shè)法 從設(shè)備工從設(shè)備2 從設(shè)備4起始信號與停止信號?起始信號：當(dāng)SCL為高期間，SDA由高到低的跳變；啟動信號是一種電平跳變時序信號，而不是一個電平信號。?停止信號：當(dāng)SCL為高期間，SDA由低到高的跳變；停止信號也是一種電平跳變時序信號，而不是一個電平信號。發(fā)送器每發(fā)送一個字節(jié)，就在時鐘脈沖9期間釋放數(shù)據(jù)線，由接收器反饋一個應(yīng)答信號。應(yīng)答信號為低電平時，規(guī)定為有效應(yīng)答位（ACK簡稱應(yīng)答位），表示接收器已經(jīng)成功地接收了該字節(jié)；應(yīng)答信號為高電平時，規(guī)定為非應(yīng)答位（NACK），一般表示接收器接收該字節(jié)沒有成功。對于反饋有效應(yīng)答位ACK的要求是，接收器在第9個時鐘脈沖之前的低電平期間將SDA線拉低，并且確保在該時鐘的高電平期間為穩(wěn)定的低電平。如果接收器是主控器，則在它收到最后一個字節(jié)后，發(fā)送一個NACK信號，以通知被控發(fā)送器結(jié)束數(shù)據(jù)發(fā)送，并釋放SDA線，以便主控接收器發(fā)送一個停止信號P。

DATA岬UTByTranw?itturDATAtlutpulbyreceiverSCLlasilernotDATA岬UTByTranw?itturDATAtlutpulbyreceiverSCLlasilernot.匚knElcdiscStartcundition.BckniMled^el2C總線劇的應(yīng)數(shù)據(jù)有效性I2C總線進(jìn)行數(shù)據(jù)傳送時，時鐘信號為高電平期間，數(shù)據(jù)線上的數(shù)據(jù)必須保持穩(wěn)定，只有在時鐘線上的信號為低電平期間，數(shù)據(jù)線上的高電平或低電平狀態(tài)才允許變化。即：數(shù)據(jù)在SCL的上升沿到來之前就需準(zhǔn)備好。并在在下降沿到來之前必須穩(wěn)定。贊求改據(jù)整定贊求改據(jù)整定I2C通訊常用基本寫時序?qū)τ谝话阍O(shè)計來說，一對I2C引腳可以掛接很多支持I2C通訊的設(shè)備，因此需要對每個I2C設(shè)定設(shè)定一個設(shè)備地址（DEVICEADDRESS，設(shè)備地址設(shè)備里面自帶，不許需要我們自己設(shè)定）。I2C一般寫時序為：主機(jī)發(fā)送起始信號一》主機(jī)發(fā)送設(shè)備地址編號（7位地址+寫位）+從機(jī)發(fā)送ACK信號+主機(jī)發(fā)送命令+從機(jī)發(fā)送ACK信號+主機(jī)發(fā)送數(shù)據(jù)+從機(jī)發(fā)送ACK信號+主機(jī)發(fā)送停止信號。ByteWriteSTARTDEVICE

ADDPE&SSDALINEmnWOFinADDRESSLSB前ByteWriteSTARTDEVICE

ADDPE&SSDALINEmnWOFinADDRESSLSB前I2C通訊常用基本讀時序I2C一般讀時序為：主機(jī)發(fā)送起始信號--》主機(jī)發(fā)送設(shè)備地址編號（7位地址+讀位）+從機(jī)發(fā)送ACK+主機(jī)發(fā)送命令+從機(jī)發(fā)送ACK+主機(jī)發(fā)送起始信號+主機(jī)發(fā)送設(shè)備地址編號（7位地址+寫位）+從機(jī)發(fā)送ACK+從機(jī)發(fā)送數(shù)據(jù)（根據(jù)主機(jī)的命令）+主機(jī)發(fā)送停止信號。RandomReadSTARTDEVICE

ADDRESSWRITEWORDADDRESSnSTARTDEVICEADDRESSREADSTOPmsbMSB

ACKSTARTDEVICE

ADDRESSWRITEWORDADDRESSnSTARTDEVICEADDRESSREADSTOPmsbMSB

ACKR/wLSBACK

LSB

MSB

ACK

LSBDATAnDUMMYWRITE1.2.2I2C驅(qū)動在STM32中的硬件實現(xiàn)I2C通訊常用基本寫時序STM32芯片中有集成了I2C模塊，通過I2C模塊，CPU軟件可以不需要關(guān)注I2C總線的協(xié)議實現(xiàn)以及通信時的具體會話過程，只需要將待發(fā)送的數(shù)據(jù)放入發(fā)送緩沖區(qū)中，啟動I2C傳輸即可，而接收的時候也可以由硬件觸發(fā)中斷，從接收緩沖區(qū)中讀取數(shù)據(jù)既可。STM32F4的I2C模塊的工作過程：1：STM32F407的I2C模塊即可以實現(xiàn)I2C主設(shè)備模式，同時也能實現(xiàn)I2C從設(shè)備模式。在飛控系統(tǒng)中，主要采用STM32F407的主設(shè)備模式:在主模式下，I2C模塊會啟動I2C總線上的數(shù)據(jù)傳輸，同時輸出SCL的時鐘信號：當(dāng)控制寄存器I2C_CR1的START位置1時，模塊自動切換到主模式下，同時在總線上發(fā)出起始位信號，狀態(tài)寄存器I2C_SR1的SB為會被硬件置1，并且當(dāng)ITEVFEN位置1時產(chǎn)生系統(tǒng)中斷：接著內(nèi)部緩沖區(qū)會將從設(shè)備地址從內(nèi)部并串轉(zhuǎn)換的移位寄存器中發(fā)送到I2C總線上，發(fā)送完畢后狀態(tài)寄存器中的ADDR位會被置1。接下來主設(shè)備會根據(jù)讀寫操作進(jìn)入接收模式或者發(fā)送模式，將最后1位置位或者復(fù)位發(fā)送到總線上。在發(fā)送完從地址信息后，主設(shè)備會檢測從設(shè)備響應(yīng)的ACK信號，只有I2C總線上的從地址設(shè)備出現(xiàn)了地址匹配命中的事件并將ACK位拉低后，主設(shè)備才能知道有相應(yīng)的從地址掛載在I2C總線上。SDASCLSMBASDASCLSMBA加速度計原理慣性測量元件是一種能夠在慣性系中測量載體自身三維加速度和三維角度的設(shè)備，主要分為加速度計和角速度計兩種，其統(tǒng)稱為慣性測量元件。根據(jù)物理學(xué)原理，加速度的積分是速度，速度的積分是位置信息；角速度的積分是角度信息加速度計，或稱加速度傳感器是一種能夠測量加速度的設(shè)備。加速度傳感器可以幫助你檢測到一個物體或事物此時此刻的狀態(tài)，是停止，還是在運動，是在向前、向后、向左、還是向右運動，以及是在向上還是向下運動。加速度傳感器甚至可以用來分析物體的振動。慣性元件：慣性測量元件本身固有的誤差由于時間積分會累積誤差，并且受到元件本身的工藝、技術(shù)和成本的緣故，其誤差越大，誤差的累積就會越快，因此在飛行上萬公里后累積的誤差可以達(dá)到幾公里甚至幾十公里，因此現(xiàn)在導(dǎo)航系統(tǒng)都是通過GNSS全球衛(wèi)星定位系統(tǒng)獲取精準(zhǔn)的定位和速度信息來對慣導(dǎo)系統(tǒng)進(jìn)行修正。其實人體也有慣性測量元件，人的耳蝸充滿液體，人在運動的時候，可以被二種的神經(jīng)感受到，因此可以測量出人體自身的運動特征。的慣性測量元件也是非常差，閉上眼睛，也不摸周圍的東西，只靠耳蝸感受的移動，人基本沒法走直線，這里眼睛的作用就相當(dāng)于GNSS的作用，它可以隨時修正耳蝸所感應(yīng)的慣性信息。MEMSMEMS是(Micro-Electro-MechanicalSystems)的英文縮寫，它是指集成微型機(jī)械結(jié)構(gòu)、微型傳感器、微型執(zhí)行器以及信號處理和控制電路、直至接口、通信和電源等于一體的微型器件或系統(tǒng)?，F(xiàn)在很多微型加速度傳感器，陀螺儀都是基于MEMS技術(shù)實現(xiàn)的。微機(jī)械加速度傳感器可以根據(jù)壓電效應(yīng)的原理來工作。壓電效應(yīng)：所謂壓電效應(yīng)就是“對于不存在對稱中心的異級晶體加在晶體上的外力除了使晶體發(fā)生形變以外，還將改變晶體的極化狀態(tài)，在晶體內(nèi)部建立電場，這種由于機(jī)械力作用使介質(zhì)發(fā)生極化的現(xiàn)象稱為正壓電效應(yīng)”。還可以根據(jù)壓阻技術(shù)、諧振式、電容效應(yīng)等原理來制作慣性測量傳感器元件，但是所有的原理基本都是由內(nèi)部集成的微機(jī)械質(zhì)量塊收到物理機(jī)械力的作用帶來的某個介質(zhì)的形變，并將產(chǎn)生形變的量轉(zhuǎn)換為電壓輸出，通過相應(yīng)的放大和濾波電路進(jìn)行采集，測量量的大小分別與電阻、電壓、電容的變化成正比。加速度計測量信息加速度傳感器分為二軸與三軸加速度傳感器，二軸加速度傳感器：能夠同時檢測兩個方向（x軸，y軸）上的加速度。三軸加速度傳感器：能夠同時檢測三個方向上的加速度，x，y，z。加速度測量一些特性有如下幾個方面：傾斜度偵測傾斜度偵測儀。加速傳感器在靜止時，可用來檢測傾斜角，傾斜角在90~+90之間變化時，重力加速度信息會分配到三個軸上，加速度傳感器輸出的三軸分量可以計算出傾斜角度運動檢測運動檢測可用于運動控制，計步器，基本運動檢測。定位偵測定位偵測用于汽車導(dǎo)航，防盜設(shè)備，地圖跟蹤。定位偵測需要測量的因素包括：加速度的范圍是多少及加速傳感器如何安裝。對加速度數(shù)據(jù)進(jìn)行二重積分即可得到位置數(shù)據(jù)。震動偵測震動偵測可用于下降記錄，黑盒子/故障記錄儀，硬盤保護(hù)，運輸和處理監(jiān)視器。震動偵測主要收集加速度計的原始數(shù)據(jù)并進(jìn)行閾值選擇。一般按照被測量對象的減速度決定了震動檢測所需的加速傳感器的規(guī)則選取。振動偵測振動偵測可用于地震活動監(jiān)視器，家電平衡和監(jiān)測。振動偵測需要考慮的因素包括：分析振動頻率的多少，確定g值的范圍及最適當(dāng)?shù)募铀賯鞲衅靼惭b位置。借助于快速傅立葉變換對加速度資料的分析可得到振動頻率的情況，快速傅立葉變換允許振動信號被分解成它的諧波分量，而每個電機(jī)振動都有它自己的諧波分量信號。自由下落偵測自由落下偵測可用于自由落體保護(hù)，下降記錄，下降檢測，運動控制和認(rèn)知等。自由落下偵測包含線性落下、旋轉(zhuǎn)型落下和拋射落下。

<a)制量加速度為。 (⑴"I量工速度為刊 2測量印理發(fā)為1加速度計原始數(shù)據(jù)采集MPU6050是一個六軸運動處理傳感器，包含了三軸加速度和三軸陀螺儀以及一個可擴(kuò)展的數(shù)字運動處理器DMP(DigitalMotionProcessor)。MPU-60X0對陀螺儀和加速度計分別用了三個16位的ADC，將其測量的模擬量轉(zhuǎn)化為可輸出的數(shù)字量。1：陀螺儀可測范圍為士250，±500，±1000，±2000°/秒(dps)2：加速度計可測范圍為±2，±4，±8，±16g1.4.2加速度計校準(zhǔn)3：上還內(nèi)嵌了一個溫度傳感器和在工作環(huán)境下僅有±1%變動的振蕩器，溫度傳感器可以實時感知傳感器所處的環(huán)境溫度，以便對傳感器進(jìn)行溫度補(bǔ)償校準(zhǔn)1.4.2加速度計校準(zhǔn)其中其中am是校準(zhǔn)前的原始測量值，由于芯片生產(chǎn)和裝配的因素該值一般都會\bf加速度計的原理特性，它的誤差模型為:ax有零點偏移誤差，在公式中用拉=匕篇來表示零點偏移補(bǔ)償，此外還有量程比aaybrTOC\o"1-5"\h\zLaZ l r5皿 00例的縮放導(dǎo)致的尺度準(zhǔn)確性，公式中用尺度因子與=05叼0來補(bǔ)償，0 0Sl az」

最后由于安裝誤差和芯片內(nèi)部感應(yīng)器件軸的扭曲因素，還需要一個旋轉(zhuǎn)因子矩納-A3/。來補(bǔ)償。加速度計的校準(zhǔn)就是要得到這幾個未知矩1陣。加速度計的校正方法可以采用六面校準(zhǔn)方法?；诘脑砭褪窃陟o止?fàn)顟B(tài)下，加速度計各軸輸出的矢量和等于重力加速度g。加速度計校準(zhǔn)---6個特殊位置在這六個特殊位置記錄下測量的數(shù)據(jù)。再計算不同角度的三維模與重力加速度g的方差的最小值。該方差值達(dá)到最小值時的各參量矩陣的數(shù)值即為校準(zhǔn)值。加九t（%Sa（%+"）"-g）2i=1其中最簡單的校準(zhǔn)方法為：找到三軸的中心零點的位置。即需要將裝配了加速度計的飛控板水平放置，Z軸朝正下方，此時理論上X與Y軸的重力分量為0，Z軸為1g的加速度測量量。這時X與Y軸所讀到的數(shù)據(jù)近似認(rèn)為是零點漂移，而Z軸的數(shù)據(jù)減去1g得到的誤差也認(rèn)為是Z軸的零點飄移。這種方法其實是忽略了三軸旋轉(zhuǎn)誤差并將這些誤差近似到零點飄移中。Cb）倒立Cb）倒立S）后惻S）前裂］（e）右根」（f）左側(cè)陀螺儀的原理陀螺儀又稱為角速度傳感器，用于檢測旋轉(zhuǎn)角速度的大小。角速度的單位deg/s（度/每秒）。MEMS陀螺儀有多種設(shè)計以及多種原理（內(nèi)/外框架驅(qū)動式、梳狀和電磁驅(qū)動式等）來實現(xiàn)陀螺儀的功能，但是基本上都是采用振動相互正交振動和轉(zhuǎn)動引起的交變科里奧利力。它的基本原理為兩個有質(zhì)量的質(zhì)量塊運動速度方向相反，大小相同，所產(chǎn)生科里奧利力相反，從而壓迫兩塊對應(yīng)的電容板移動，產(chǎn)生電容差分變化。因為加速度變化只能促使兩個質(zhì)量塊朝相同方向移動，不會帶來電容差分變化，因此電容差分變化與旋轉(zhuǎn)角速度成正比。科里奧利力（Coriolisforce）有些地方也稱作哥里奧利力，簡稱為科氏力，是對旋轉(zhuǎn)體系中進(jìn)行直線運動的質(zhì)點由于慣性相對于旋轉(zhuǎn)體系產(chǎn)生的直線運動的偏移的一種描述。FFgrioiis工-2mClxv陀螺儀的測量信息三自由度陀螺儀具有內(nèi)、外兩個框架，使轉(zhuǎn)子自轉(zhuǎn)軸具有兩個轉(zhuǎn)動自由度。在沒有任何力矩裝置時，它就是一個自由陀螺儀。陀螺儀作用于航空、航天、航海、兵器、汽車、生物醫(yī)學(xué)、環(huán)境監(jiān)控等領(lǐng)域。陀螺儀可以根據(jù)需要提供準(zhǔn)確的方位、水平、位置、速度和加速度等信號。主要應(yīng)用于：導(dǎo)航。配合GPS，手機(jī)的導(dǎo)航能力將達(dá)到前所未有的水準(zhǔn)。實際上，目前很多專業(yè)手持式GPS上也裝了陀螺儀，如果手機(jī)上安裝了相應(yīng)的軟件，其導(dǎo)航能力絕不亞于目前很多船舶、飛機(jī)上用的導(dǎo)航儀。各類游戲的傳感器，比如飛行游戲，體育類游戲，甚至包括一些第一視角類射擊游戲，陀螺儀完整監(jiān)測游戲者手的位移，從而實現(xiàn)各種游戲操作效果?？梢杂米鬏斎朐O(shè)備，陀螺儀相當(dāng)于一個立體的鼠標(biāo)，這個功能和第三大用途中的游戲傳感器很類似，甚至可以認(rèn)為是一種類型。陀螺儀校準(zhǔn)? 三軸陀螺儀在生產(chǎn)與實際應(yīng)用中同樣也會引入三軸偏差，以及零點偏差的因素。因此同樣需要對陀螺儀傳感器進(jìn)行精確校準(zhǔn)。類似加速度傳感器，三軸陀螺儀的誤差模型可以用式3=RS（3,+b'）m^^m3其中3八是校準(zhǔn)前的原始測量值，由于芯片生產(chǎn)和裝配的因素該值一般都\bf3%會有零點偏移誤差，在公式中用枚=%來表示零點偏移補(bǔ)償，此外還3 3〉brl3Z」有量程比例的縮放導(dǎo)致的尺度準(zhǔn)確性，公式中用尺度因子Sg=Sax 0 00 s 0來補(bǔ)償，最后由于安裝誤差和芯片內(nèi)部感應(yīng)器件軸的扭3V00s3Z」1納曲因素，還需要一個旋轉(zhuǎn)因子矩陣此=一紳 1』6 -J0陀螺儀傳感器的校準(zhǔn)就是要得到這幾個未知矩陣。陀螺儀的校正方法可以采用積分推算校準(zhǔn)方法?；诘脑砭褪怯捎谌S角速度的積分可以得到角度信息，因此使用已經(jīng)校準(zhǔn)的三軸加速度計信息得到的角度信息可以用來校準(zhǔn)陀螺儀的未知校準(zhǔn)參數(shù)。積分推算校準(zhǔn)的主要思路就是采用根據(jù)陀螺儀的包含校準(zhǔn)參數(shù)的數(shù)據(jù)轉(zhuǎn)換為四元數(shù)旋轉(zhuǎn)矢量迭代到上一時刻已校準(zhǔn)過的三軸加速度計，獲得旋轉(zhuǎn)的角度進(jìn)而獲得更新時刻的加速度值，該加速度值與新時刻的校準(zhǔn)加速度數(shù)據(jù)的方差應(yīng)該達(dá)到最小。該方差值達(dá)到最小值時的各參量矩陣的數(shù)值即為校準(zhǔn)值。其中最簡單的校準(zhǔn)方法為：找到三軸陀螺儀的中心零點的位置。即需要將裝配了陀螺儀的飛控板水平放置，Z軸朝正下方，此時理論上X、Y與Z軸的旋轉(zhuǎn)矢量均為0。這時X、Y與Z軸所讀到的數(shù)據(jù)近似認(rèn)為是零點漂移，這種方法其實是忽略了三軸旋轉(zhuǎn)誤差并將這些誤差近似到零點飄移中。磁力計的原理? 磁力計指的是各種用來測量磁場的儀器，也稱磁力儀、高斯計。飛行器的機(jī)頭朝向是指向哪個方位，這個狀態(tài)量稱為航向，也是飛行器三維姿態(tài)信息中的一維。磁力計通過測量大地的磁場強(qiáng)度可以獲得載體的航向信息、。磁力計之所以由于能夠獲得航向信息是因為地球空間周圍有著磁場，磁場強(qiáng)度大約為0.5?0.6高斯，磁力計可以測量出穿過大地的三維地磁強(qiáng)度，從而獲得載體相對于地磁線的偏轉(zhuǎn)方位。d^pgrfephk.NorthMeNorthM^HneEk6d^pgrfephk.NorthMeNorthM^HneEk6滬鮮這種磁力計采用各向異性的磁致電阻(AnisotropicMagneto-Resistance)材料來檢測空間中磁感應(yīng)強(qiáng)度的大小。這種具有晶體結(jié)構(gòu)的合金材料對外界的磁場非常敏感，磁場的強(qiáng)弱變化會導(dǎo)致AMR電阻值發(fā)生變化。在制造過程中，將一個強(qiáng)磁場加在AMR上使其在某一方向上磁化，建立起一個主磁域，與主磁域垂直的軸被稱為該AMR的敏感軸；為了使測量結(jié)果以線性的方式變化，AMR材料上的金屬導(dǎo)線呈45°角傾斜排列，電流從這些導(dǎo)線上流過；由初始的強(qiáng)磁場在AMR材料上建立起來的主磁域和電流的方向有45°的夾角。AMR材料示意圖AMR材料示意圖角排列的導(dǎo)線.當(dāng)有外界磁場Ha時，AMR上主磁域方向就會發(fā)生變化而不再是初始的方向了，那么磁場方向和電流的夾角。也會發(fā)生變化。對于AMR材料來說，。角的變化會引起AMR自身阻值的變化，并且呈線性關(guān)系。磁力計中再利用惠斯通電橋檢測AMR阻值的變化，如圖5-13所示。R1/R2/R3/R4是初始狀態(tài)相同的AMR電阻，但是R1/R2和R3/R4具有相反的磁化特性。當(dāng)檢測到外界磁場的時候，R1/R2阻值增加AR而R3/R4減少AR。這樣在沒有外界磁場的情況下，電橋的輸出為零；而在有外界磁場時電橋的輸出為一個微小的電壓AV。當(dāng)R1=R2=R3=R4=R，在外界磁場的作用下電阻變化為AR時，電橋輸出AV正比于AR。I. C磁力計的測量信息雖然大地磁場強(qiáng)度在除了南北磁極的地方是垂直于大地水平面，而在其他位置都是平行于水平面，但磁力計一般都為三軸磁力計，因為在使用過程中，我們不能保證磁力計完全水平，而三軸磁力計就可以同時測量慣性系三維空間的三個方向上的磁力磁力計原始數(shù)據(jù)采集HMC5883L包括最先進(jìn)的高分辨率HMC118X系列磁阻傳感器，并附帶霍尼韋爾專利的集成電路包括放大器、自動消磁驅(qū)動器、偏差校準(zhǔn)、能使羅盤精度控制在1°?2°的12位模數(shù)轉(zhuǎn)換器，簡易的I2C系列總線接口。磁力計校準(zhǔn)地球磁場的強(qiáng)度本身極其微弱，只有0.5?0.6高斯，它很容易受到外界金屬及電磁設(shè)備的干擾和影響，甚至機(jī)載的電機(jī)旋轉(zhuǎn)的過程中都會對磁場產(chǎn)生強(qiáng)烈的干擾。因此磁力計是一個極易受干擾的脆弱的傳感器件。在很多應(yīng)用于電力巡線等復(fù)雜電磁場環(huán)境應(yīng)用場合的大型工業(yè)無人機(jī)的設(shè)備中，甚至采用雙

GPS來提取機(jī)頭航向信息，而避免使用電子羅盤的信息。因此在常用的機(jī)載磁力計傳感器上，必須要針對磁力計進(jìn)行校準(zhǔn)，以避免對慣導(dǎo)算法造成太大的影響。如果不存在外部磁場干擾的情況下，傳感器只應(yīng)該能夠感應(yīng)到地球磁場，由于地球磁場是一個恒定方向(指北)，那么如果將傳感器水平旋轉(zhuǎn)一周的時候，地球磁場矢量將均勻分布在X,Y兩軸上，形成一個標(biāo)準(zhǔn)的圓形，如果將傳感器按空間各方向旋轉(zhuǎn)360度的情況下，地球磁場矢量將均勻分布在X,Y,Z三軸上，形成一個標(biāo)準(zhǔn)的三維圓球。校準(zhǔn)之前數(shù)據(jù)擬合校準(zhǔn)之后數(shù)據(jù)擬合校準(zhǔn)之前數(shù)據(jù)擬合校準(zhǔn)之后數(shù)據(jù)擬合1.7.1磁力計校準(zhǔn)原理首先建立數(shù)值模型，定義傳感器測量值1.7.1磁力計校準(zhǔn)原理首先建立數(shù)值模型，定義傳感器測量值m，=[xmymZm"，校準(zhǔn)之后的值為m=[xcsmx為m=[xcsmx[000smy0yc Zc]T，圓心偏移參數(shù)b，=[bx00]。smZbybZ]T，比例尺度參數(shù)Sm他們之間的關(guān)系如下所示m=Sm(m，+b，)(x=(x+b),scmxmxyc=(ym+by)"myZc=(Zm+bz),smz校正后的校正值應(yīng)該近似分布在一個圓球上，圓球的公式為：x2+y2+z2=R2，所以我們將校正值帶入圓球公式，與理論的圓球半徑求方差，構(gòu)建誤差u=x2+y2+Z2—R2c,cc將校正值用測量值替換：u=s2x2+b2s2+2xbs2+s2y2+b2s2+2ybs2+s2Z2+b2s2mxmxmxmxmxmymymymymymZmzmZ+2zbs2—R2mzmz可以看到，形態(tài)類似橢圓公式V=[x2y2Z2xyz 1]tm"mmm"mm

P=[abcdefg]T

a=s2mxb=S2my其中C=S2mzd=2bs2其中xmxe=2bs2ymyf=2bs2zmzg=bxsmx+b2smy+b2smz-R2則誤差計算為：u=axm+bym+czm+dxm+eym+fzm+g=VtxP這里的W是對于所有的采樣測試點求和。u是一個二次函數(shù)，其有極小值點。通過將u的函數(shù)對于所有變量求偏導(dǎo)，并計算偏導(dǎo)為0時，u可取得最小極值點，即1.9磁力計傳感器定義W（^x〃）=｛（^X^7X尸）=（W^X^7）X尸=3X尸=0其中，B是測量點矩陣，P為恒定的待求參數(shù)矩陣，因此可以通過高斯消元法求齊次線性方程組，來求得P的各個參數(shù)的解可以將上式改寫成3xkP=0,其中k是一個任意常數(shù)即P=k4=k4M"kqMdmqk/M%]T通過解線性方程組求得的只是這個解系中的一個基本解，所以首先求出這個基本解的k值。經(jīng)算是可以推導(dǎo)如下，帶入a,b,c,d,e,f,g即可求解：（上+M+匯-4*g）7 'a萬c?）4A2k= 4A2求得的最后解為:

mxmx該校準(zhǔn)方法運算量較大，編程較為復(fù)雜。當(dāng)在一定精度上確保傳感器水平時，可以采用簡化的方法來進(jìn)行校準(zhǔn)，即只校準(zhǔn)水平方向上的量。此外由于飛控算法僅需要磁力計的矢量方向信號對四元數(shù)進(jìn)行矩陣，因此實際使用時都將矢量歸一化，因此比例因素可以忽略。超聲波傳感器原理人耳朵能聽到的聲波頻率為20?20000Hz，當(dāng)聲波的震動頻率大于20000Hz時，人耳無法聽到。因此，我們把頻率高于20000赫茲的聲波稱為超聲波特點：超聲波的波長相對來說比聲波要短，通常的障礙物都會比超聲波的波長大很多，所以說超聲波的衍射能力不是很強(qiáng)，在介質(zhì)一定密度不變的情況下，超聲波能夠沿著波的方向一致沿直線傳波，超聲波的波長相對來說越短的話，直射能力就越好超聲波傳感器簡介在制作無人機(jī)的時候，需要實時采集有關(guān)自身位置的相關(guān)數(shù)據(jù)，雖然可以通過GPS來采集有關(guān)無人機(jī)相關(guān)位置的數(shù)據(jù)，但是一旦有建筑甚至是樹木