如何深入理解無人機硬體與演算法？—狀態
常見飛行器機型系列告一段落後，MR.城堡專欄的「城堡里學無人機系列」將逐漸深入到演算法、硬體、無人機設計等內容。首先面對的問題就是如何選擇合適的「過渡切入點」，即如何找到一個切入點能夠讓喜歡無人機的朋友們容易過渡到無人機的專業內容，這個環節非常重要。因為大家雖然都很喜歡無人機，但現實情況是每個人的教育背景，對無人機的需求，看待問題和事物的習慣與角度等都有很大區別。
最常見的切入視角是從硬體和數學模型進行切入。硬體視角常從GPS，強磁計，紅外設備，雙目視覺，IMU，單目視覺等硬體模塊的性能、用法（其實很多文章並不涉及用法）、輸入輸出數據類型等著眼。比較直觀，易於操作，易被接受。但容易讓對讀者無法構建對於無人機整個系統的理解，並陷入到某一個具體硬體中，甚至忘卻了該硬體對於無人機的意義。
從數學的視角來切入，常會研究被控對象的模型性質，非線性，非最小相位系統，耦合特性等等。這樣的視角足夠深入，接近被控對象本質，但抽象性太強，容易造成和實物的脫節。
硬體和數學模型兩個視角都很重要，卻也都存在著無法迴避的問題。因此MR.城堡決定選擇無人機的「狀態」作為切入視角。從「狀態」視角很容易理解硬體在整個無人機系統中的實際意義：構成反饋閉環並傳回相應的「狀態信息」，從而為控制器設計提供必要的反饋信息。
無人機「狀態」數目根據不同的機型會有所區別。大家從上面兩幅圖中就可以看出，直升機型無人機相比於四旋翼就會多出兩個揮舞角（Flapping angle）作為描述揮舞動態的狀態。
無人機狀態可以「大體」分為兩部分，描述「外部位置環」的六個狀態，位置狀態：x,y,z該狀態體現了無人機在三個軸線上所處的具體位置；速度狀態：u,v,w用於描述無人機本身沿三個方向的飛行線速度；「內部姿態環」的六個狀態，姿態角狀態：phi,theta,psi分別描述無人機的橫滾、俯仰、偏航姿態角；角速度狀態：p,q,r描述無人機在機身三個旋轉軸上的轉動速率。
這裡「外環」，「內環」的稱呼是由無人機控制器設計中的常用控制器結構所演變出來的術語，大家現階段不必深究。直觀來看兩組狀態分別處於不同的坐標系中，外環狀態：x,y,z,u,v,w處於「大地坐標系」（速度狀態信息在機體坐標系下只要進行坐標變換即可）視角下
而內環狀態:phi,theta,psi,p,q,r則是處於「機體坐標系」中。
上圖可以看到，通過內外環狀態信息的閉環反饋，求得「期望狀態」與「真實狀態」之間的誤差值，並根據這個誤差設計不同結構的控制器，根據不同演算法計算出需要的控制量。
狀態反饋就是通過各種無人機硬體實現的，因此可以直接通過反饋的狀態信息類型進行硬體歸類
位置狀態-反饋絕對「位置狀態」信息的硬體：GPS（x,y,z），氣壓計(z)以及反饋相對「位置狀態」信息的硬體：紅外感測器、超聲波，單目視覺、雙目視覺（這一大類根據硬體數量和位置能夠返回不同維度量的狀態信息）；速度狀態-反饋絕對「速度狀態」信息的硬體，由於位置和速度的微分關係獲得，大家直接把上面的硬體搬下來就可以了:GPS,氣壓計，以及相對位置狀態硬體。
無人機內環姿態信息包括六個狀態：姿態角三個，角速度三個。角速度狀態由陀螺儀反饋。姿態角數據的反饋硬體構架可根據姿態演算法的不同而發生變化，硬體會根據相關演算法的選擇進行設計如：加速度計+強磁計或者陀螺儀+加速度計+強磁計。
無人機產品中經常使用IMU（Inertial measurement unit）獲取內環狀態信息。而IMU和INS(Inertial Navigation System)經常被混用。從上圖中可以很直觀地看到，IMU實現了無人機線性加速度信息（加速度一般不看做狀態，而常在姿態計算中使用）和角速度狀態信息的反饋。而INS則負責對信息進行處理，實現位置、速度、姿態角等狀態的信息反饋。大家注意到上圖中獲取姿態的演算法是直接採用對角速度積分的方法，而在實際產品中由於積分會導致誤差積累，因此更多的使用加速度+偏航角+角速度+濾波演算法的數據融合演算法進行姿態解算。
?以無人機產品功能實現為例，看看狀態視角如何讓我們更好的理解無人機技術。最近在Kickstarter上完成眾籌目標的斯凱智能的無人機系統主打Target Tracking功能，我們就從「狀態」視角看看如何從硬體和演算法上實現無人機跟蹤功能。
當我們自己在跟蹤一個對象時，需要知道對方走到哪裡去了，自己現在的位置，別跟的太緊，也別被拋開太遠，需調整步伐保持理想的跟蹤距離。
對於無人機而言整個過程也大體類似。無人機需要獲取被控對象的「位置信息」以及被反饋回的無人機自身「位置狀態」，計算出兩者之間的相對距離誤差，再通過硬體或者演算法，計算出速度變化，如被跟蹤對象的速度大小，速度方向，並以此來「控制」無人機自身的速度以實現位置的跟蹤。
因此無論採用GPS還是光流單目抑或雙目視覺、紅外、超聲波等等，不管什麼硬體，作用都是為了傳輸回無人機對應的外環狀態信息。
同樣的，無論採用隨身tracker還是內置感測系統的地面站式遙控器抑或直接採用手機，都可以傳輸回被跟蹤目標的「外環狀態信息」。
兩者比較，形成狀態誤差，通過IMU等感測器反饋無人機內環姿態信息，與目標姿態形成狀態誤差，並以此計算得出控制量。
通過狀態視角，可以很清晰的理解不同產品的硬體意義，並以此設計自己的無人機控制系統。
圍繞著無人機狀態反饋信息的處理和使用，演算法可以走向兩個不同的分支：數據融合（數據濾波）和自動控制。根據不同的狀態特點，圍繞數學模型建立系統框架，根據演算法以及反饋狀態信息的要求選擇相關的硬體搭建無人機系統等內容是無人機控制系統設計的清晰脈絡。MR.城堡會在後續系列文章中逐漸搭建這個系統架構中的各個部分，幫助不同行業喜歡無人機的朋友走入奇妙的無人機世界。
本文圖片來自互聯網搜索及參考文獻截圖
[1]Unmanned Rotorcraft Systems.GuoWei Cai.Ben M.Chen.Tong Heng Lee
[2]Principles.of.Helicopter.Aerodynamics,J.Gordon.Leishman,2ed,CUP2006(ED2000.COM)
[3]Helicopter.flight.dynamics.qualities.and.simulation.modelling.2Ed
[4]Backstepping Approach for Controlling a Quadrotor Using Lagrange Form Dynamics
城堡無人機工作室公眾號：CastleUAVStudio。無人機技術、市場、行業合作、分析、分享。
※KFC不好好做雞，居然去做吮指香辣指甲油？
※怎樣克服密集恐懼症？
TAG:知識百科 |