0 引言

航空攝影（Aerial Photography）又稱航拍，是指在飛機或其他航空飛行器上利用航空攝影機攝取地面景物相片的技術。目前，航空攝影應用廣泛，是獲取地理信息的主要手段[1-2]。在航空攝影中，存在著一個難題需要解決：飛機在飛行攝影時會受到本機和氣流等的影響，從而產生機體振動，相機的姿態角也會隨著改變，相機姿態時刻改變就會給高精度拍攝帶來困難。所以為提高航拍質量，必須對相機姿態進行校正[3]。

校正的前提是獲取相機姿態，所以慣性測量元件必不可少，但是單一的慣性測量元件無法給出準確的姿態角，需要對多個慣性測量元件的數據進行數據融合。使用比較普遍的慣性測量元件的組合是加速度計和陀螺儀。它們輸出的數據各有優缺點，可以使用Kalman濾波對其進行數據融合以得到準確的姿態角[4-5]。

現有的實現Kalman濾波的方式主要有兩種：PC機和DSP，兩者都存在著系統性能和成本不能兼顧的問題。而FPGA卻可以很好地解決這個問題。本文主要講述的便是用FPGA實現Kalman濾波來獲取準確的相機姿態。

1 坐標模型

在進行航拍作業時，相機搭載在云臺上，云臺和飛機是一體的，當相機拍攝地面照片時，相機拍攝方向應與地面垂直，如圖1所示。

為獲取相機姿態，首先以相機為原點，建立坐標系，如圖2所示。其中，XY平面與地面平行，Z軸垂直于地面，Y軸方向為飛機飛行方向。

將加速度計固定在相機上，當相機姿態發生改變時，加速度的3個敏感軸便可以輸出在其相應方向產生的重力分量信號，如圖2中的Gx，Gy，Gz所示。陀螺儀是一種角速度傳感器，它可以輸出對應軸上的瞬時角速度，如圖2中的Wx，Wy，Wz所示。

根據以上坐標系，可以得到姿態角θx，θy，θz（分別代表著俯仰角、橫滾角、偏航角），如式1所示，其中ΔT為采樣時間，Δθ為采樣時間內的姿態角變化。

可見，由加速度計或者陀螺儀都可以初步得到姿態角，但是無論是加速度計還是陀螺儀，它們輸出的原始數據都存在著固有缺陷：當相機處于變速運動狀態時，加速度計的輸出并不是重力加速度，而是重力加速度和其自身加速度的矢量和。陀螺儀是通過對角速度積分得到姿態角，隨著時間的推移，姿態角的誤差會越來越大。所以單一的加速度計或者陀螺儀都無法獲得正確的姿態角，必須對兩者進行數據融合。

2 Kalman濾波模型的建立

Kalman濾波是在時域內以信號的一、二階統計特性已知為前提、以均方誤差極小為判據，能自動跟蹤信號統計性質的非平穩變化，具有遞歸性質的一種算法[5]。Kalman濾波的狀態方程和預測方程如式(2)所示：

其中，Xk+1為系統的狀態向量，Φk+1，k為狀態轉移矩陣，Tk+1，k為控制系數矩陣，Uk為系統控制輸入，Γk+1為噪聲系數矩陣，Wk為系統的過程噪聲序列，Zk+1為系統的觀測序列，Hk+1為觀測矩陣，Vk+1為觀測噪聲序列。

使用陀螺儀數據建立線性模型，如式(3)所示：

其中，θk為飛行姿態角，βk為陀螺儀輸出的誤差，Uk是陀螺儀輸出的角速度數據，ΔT是采樣時間間隔。因為陀螺儀輸出的誤差整體來看變化不大，可認為βk+1=βk。因Wk對系統影響甚小，這里規定Wk=0。

由以上建立狀態矩陣方程，如式(4)所示：

陀螺儀和加速度計測量姿態角時各有優缺點，為獲得比較可靠的姿態角數據，必須對兩者的數據優勢互補。以上算法用加速度計數據得到不同階段的測量噪聲協方差，并帶入解算過程中，大大減少了姿態角的測量誤差。

3 Kalman硬件實現

目前Kalman濾波器的實現方式主要有PC機和DSP兩種方式，PC機可以同時滿足計算精度和實時性的要求，但是PC機體積大、質量重、成本高；DSP實現的Kalman濾波器雖然體積小，質量輕，但是因其指令順序執行的CPU架構，在系統復雜時無法滿足系統的實時性要求[6-7]。

因此，Kalman濾波器在工程應用中的實現遇到了系統體積、重量、成本與系統精度、速度等性能不能兼顧的問題。FPGA是解決這一問題的有效途徑，FPGA具有極高并行度的信號處理能力、高度的靈活性、現場可以編程、較短的開發周期和較低的成本等優勢，在數字信號處理領域已經得到廣泛的應用[8]。

本系統使用的FPGA芯片是Altera公司Cyclone II系列中的EP2C35F672C6，它共有33 216個邏輯單元、483 840個存儲單元、70個乘法器單元（9 bit）。雖然Altera公司提供了很多功能強大的IP核，其中就包括加減乘除單精度浮點數運算，但是提供的IP核占用資源過多，所以使用自己編寫的運算模塊。下面以除法模塊為例說明浮點數運算的硬件實現。

3.1 浮點數除法模塊

根據IEEE754標準，單精度浮點數的格式如圖2所示。

通常可用式(11)表示一個單精度浮點數：

從式(12)中可以看到，符號位和階碼的運算比較簡單，尾數的運算較為復雜。

設被除數為a，除數為b，第i次的商為qi，第i次得到的臨時余數為mi，令m0=a，則有式(13)：

這樣一直進行23次運算便可以獲得全部的qi，23位qi按先后順序組合起來便是尾數運算的結果。

除法模塊資源使用情況如圖3所示，只使用了1%的邏輯單元，相比較于IP核的實現方式，大大減少了使用資源。

再用ModelSim仿真觀察除法模塊運算速度，結果如圖4所示。x1，x2是除數和被除數，y是商，isdone是標志信號，當完成一次除法運算后產生一個正脈沖。

由圖4可以看到，除法模塊運算一次共使用了25個CLK周期，完全可以滿足運算要求。

3.2 Kalman硬件模塊

以第2節中建立的卡爾曼濾波模型搭建硬件模塊，硬件模塊的結構如圖5所示。其中，

為整個Kalman濾波的結果矩陣，包括橫滾角、俯仰角、偏航角。

Kalman硬件模塊使用資源情況如圖6所示。可見，一共使用了45%的邏輯單元。雖然占用資源非常多，但是45%的資源使用還是可以接受的。

利用Multisim仿真，查看此Kalman硬件模塊的運行速度，結果如圖7所示。

q1、q2、q3是Kalman濾波解算一次后的3個偏轉角（橫滾角、俯仰角、航向角），q1st、q2st、q3st是解算一次完成后產生的負脈沖信號。從仿真結果來看，在仿真頻率為100 MHz情況下，Kalman解算一次需要的時間是1 ms，可見用FPGA來實現Kalman濾波速度是很快的。

4 實驗結果

為檢驗Kalman濾波硬件模塊實際效果，設計了一次模擬實驗：將云臺置于振動環境中，改變云臺姿態角，觀察未經濾波處理和經過濾波處理的姿態角。

實驗中使用MPU6050作為系統的姿態傳感器，MPU-6050是一款整合了3軸陀螺儀、3軸加速度計的6軸運動處理組件，相比較于多組件方案，免除了組合陀螺儀與加速度計時之軸間差的問題，減少了大量的包裝空間。

設置采樣頻率為1 kHz，以橫滾角為示例，實驗結果如圖8所示。

濾波前的橫滾角由三軸加速度和式（1）得到，可以看到明顯的噪聲和毛刺。經過Kalman濾波后，大部分的噪聲和毛刺都被去除掉了，而且通過濾波前后的橫坐標對比可以看到此濾波模塊有著很好的實時性能。

觀察濾波結果與真實值之間的誤差，如圖9所示。從圖中可以看到，濾波誤差控制在-1.5°～1.5°范圍內。可以滿足航拍系統的精度要求。

5 結論

實驗證明，本文所介紹的硬件Kalman濾波器適用于航拍相機平臺的姿態獲取。基于FPGA的硬件架構具有靈活的可移植特性和優良的抗干擾能力，相比較于DSP和PC機的實現方式，它在保證航拍系統的精度要求的前提下解決了性能和成本不能兼顧的問題，因此它具有更廣泛的應用性和實際工程意義。

參考文獻

[1] 劉先林，段福洲，宮輝力.航空攝影科技發展成就與未來展望[J].前沿科學，2007，3(3)：10-14.

[2] 張祖勛.數字攝影測量發展與展望[J].地理信息世界，2004，2(3)：1-5.

[3] 高同躍，丁衛，高新聞，等.機載慣性穩定云臺系統的研究[J].2010，18(2)：344-347.

[4] 卞鴻巍,李安,覃方君，等.現代信息融合技術在組合導航中的應用[M].北京：國防工業出版社，2010.

[5] 付夢印，鄧志紅，閆莉萍.Kalman濾波理論及其在導航系統中的應用(第二版)[M].北京：科學出版社，2010.

[6] 謝鑫，郭美鳳，周斌.基于雙DSP和FPGA的高性能導航計算機設計[J].微計算機信息，2009(3)：1-2，60.

[7] 張沖，吳秋平.基于PC104和DSP的分布式導航計算機設計[J].微計算機信息，2010(8)：27-29.

[8] 米月琴，黃軍榮.基于FPGA的Kalman濾波器的設計[J].電子科技，2010，23(2)：52-55.

編輯：jq