基于Nios II的機器人視覺伺服控制器的研究與設計

　　Altera公司的Nios II處理器是可編程邏輯器件的軟核處理器。NiosII軟核處理器和存儲器、I／O接口等外設可嵌入到FPGA中，組成一個可編程單芯片系統（SOPC），大大降低了系統的成本、體積和功耗。適合網絡、電信、數據通信、嵌入式和消費市場等各種嵌入式應用場合。

　　本文提出一個基于Nios II處理器結構的系統用于實現機器人實時運動檢測跟蹤，使用線性卡爾曼濾波器算法來快速完成運動估計及進一步分析和校正，算法中的乘除利用MATLAB／DSP Builder生成的模塊作為Nios II處理器的自定義指令的設計方法。

　　機器人視覺伺服控制器的研究與設計

　　機器人視覺伺服控制就是用各種成像系統代替視覺器官作為輸入的敏感手段，并由高速處理器替代大腦完成相應的處理和解釋，其較終研究目標就是使機器人視覺伺服控制器能像人那樣通過視覺觀察和理解世界，具有自主適應環境的能力，可依據視覺敏感和反饋，以某種程度的智能完成一定的任務。

　　系統硬件實現

　　基于SOPC的機器人視覺伺服控制器，主要由FPGA、存儲器和外設三個部分，如圖1所示。

　　攝像頭位置固定，它所能采集圖像的范圍稱為視覺區域，調整攝像機使視覺區域覆蓋機器人的工作空間，即機器人要跟蹤的曲線在該視覺區域內。利用攝像機采集圖像，而后系統對采集的圖像進行處理，分析、提取出離散的采樣點序列，較后再根據采樣點序列規劃機器人的運動路徑。其中，FPGA部分核心是Nios II處理器Core。在一般的嵌入式系統開發中，當需要新的外設模塊時往往需要在PCB上加入相應的外設芯片或者換用更高檔的CPU，而SOPC設計可以同一個FPGA芯片內加入相應的外設模塊核，并通過在片上的Avalon總線與NiosⅡ處理器Core相連，因而不需要在PCB這個層面上作更多的修改。成像采集裝置從目標對象場景中采集圖像序列，保存在SOPC的片外存儲器中，然后利用NiosⅡ處理器和定制的乘法、除法等DSP運算指令來實現線形卡爾曼濾波器的算法，從而實現運動目標的識別與跟蹤。

　　系統軟件的實現

　　離散線性卡爾曼濾波算法

　　線性卡爾曼濾波是美國工程師Kalman在線性較小方差估計的基礎上，提出的數學結構上比較簡單的較優線性遞推濾波方法，具有計算量、存儲量低，實時性高的優點。特別是經歷了初始濾波的過渡狀態后，濾波效果非常好。

　　線性卡爾曼濾波基本算法如下：設一隨機動態系統，其數學模型為：

　　公式1中x（k）為系統狀態矢量，w（k）為系統噪音矢量,φ（k）,Г（k）為系統矩陣,公式2中Z（k）為系統觀測矢量，H（k）為系統觀測矩陣，V（k）為系統觀測噪音矩陣。

　　關于系統的隨機性，本文假定，系統噪音和觀測噪音是不相關的零均值高斯白噪聲。隨機系統的狀態估計問題，就是根據選定的估計準則和獲取的測量信息對系統狀態進行估計，卡爾曼濾波的估計準則是：

　　其中，即估計是x（k）無偏和較小方差，根據這兩個準則可推導出對系統的完整的濾波算法，即：

　　預測誤差方程為：

　　增益矩陣方程為：

　　濾波誤差方差陣為：

　　上述公式中I是單位矩陣，Q為w（k）自協方差方差陣，R為V（k）自協方差方差陣。卡爾曼濾波采用遞推算法，計算較優濾波值時，K（k+1）由P（k+1|k）來確定，P（k+1|k）由P（k）來確定，P（k+1）由P（k+1|k）和K（k+1）來確定，如此反復遞推運算。

　　系統程序流程

　　本系統的主要功能是完成運動目標的鎖定，并控制運動平臺對目標進行實時跟蹤。使用高性能NiosII處理器作為控制器控制著整個系統的實現流程和高效的線性卡爾曼濾波算法對目標運動參數的估計，有效地提高了圖像處理速度，實現了運動目標的快速跟蹤。以下是系統流程：

　　1．系統初始化：由SOPC通過控制總線設置USB接口微型攝像頭工作模式，并初始化其主控程序變量。

　　2．確定運動區域：由Nios II處理器根據圖像序列鎖定運動物體，根據被跟蹤物體確定運動跟蹤區間，接下來的跟蹤操作都是在這個跟蹤窗口中進行。

　　3．預測計算：利用線形卡爾曼濾波器方程進行計算。

　　4．濾波：預測和濾波是相互作用的，即由濾波得到預測而由預測又可得到濾波。

　　5．輸出：SOPC發出控制信號給隨動平臺。

　　該系統采用集成了Nios軟核處理器的Stratix高密度FPGA，控制器通過攝像頭記錄每一時刻運動目標的位置和速度作為觀測值。然后按照公式（3）、（4）、（5）、（6）進行較佳狀態估計，得到每一時刻運動目標的位置和速度的預測值。由于各種干擾因素的存在，經過七八個時間段后預測位置與觀測位置相當接近，即可實現準確的狀態預測。

　　結語

      本文建立了一套基于SOPC結構的多關節機器人視覺伺服系統，主要應用線性卡爾曼濾波算法成功的預測了運動目標的狀態參數功能是鎖定運動目標，實現對目標進行實時跟蹤。由于應用卡爾曼濾波后極大地縮小了搜索空間，減少了系統的圖像處理時間，可以有效地提高系統的實時性，實現對運動目標的快速跟蹤。

相關閱讀:

• ...2013/09/25 16:49·安森美半導體基于NCP1246和NCP4354低待機能耗電源適配器方案
• ...2013/03/27 10:10·基于NI PXI Express平臺的石油管復合擠毀試驗機控制與數據采集系統搭建
• ...2012/08/13 15:04·基于NI CompactRIO的太陽能熔爐智能化控制和數據采集系統
• ...2011/12/09 12:19·基于NI LabVIEW的自動割草機
• ...2011/11/28 14:39·基于nRF2401的牲畜信息讀寫器的研究
• ...2011/10/08 13:45·基于nRF905的LED屏無線通信設計與實現