一種通用的無人機視覺仿真平臺的制作方法
【技術領域】
[0001]本發明涉及無人機視覺自動控制領域，尤其是一種能夠使仿真與真機相結合的
-ψ-
口 O
【背景技術】
[0002]近幾年無論是在研宄方面還是商業應用方面，無人機的領域是越來越火爆，而無人機仿真系統作為一個比較新穎的領域，它在社會上的需求也是越來越高，與真機測試相比，它能夠有效地避免飛機在測試過程中的損傷。通過無人機的仿真系統，可以無消耗、安全的測試視覺的算法和飛行器自動控制。
[0003]但是目前的無人機仿真系統主要只針對一種飛機，例如TUM的AR.Drone仿真系統，而且它只能測試一種視覺算法，沒有什么擴展性和通用性，其他的仿真系統甚至無法與真機進行算法測試的對接，這樣就失去了仿真的最終意義。
【發明內容】
[0004]為了克服已有無人機仿真方式的對象單一、擴展性和通用性較差的不足，本發明提供一種具有良好的擴展性和通用性的無人機視覺仿真平臺。
[0005]本發明解決其技術問題所采用的技術方案是:
[0006]一種通用的無人機視覺仿真平臺，包括仿真環境部分和真實環境部分，所述仿真環境部分包括機器人操作系統R0S、開源的機器人仿真平臺模塊Gazebo、視覺算法庫和用于把ROS系統傳過來的信息轉換成不同飛控能識別的控制信息的通用無人機連接接口，所述通用無人機連接接口支持ROS系統，所述開源的機器人仿真平臺模塊Gazebo、視覺算法庫和通用無人機連接接口均與機器人操作系統ROS連接；所述真實環境部分包括飛行器機架和飛行控制器，所述通用無人機連接接口與所述飛行控制器連接。
[0007]進一步，所述通用無人機連接接口中，輸入端是ROS系統傳入的邏輯層控制信息，獲取到邏輯層控制信息后，在準備發送給無人機的飛控之前需要進行數據的預處理，對控制信息針對某個飛控進行轉化后發給飛行控制器。
[0008]再進一步，所述轉化的過程如下:針對AR.Drone的飛控需要把邏輯的上下左右控制轉化為AR.Drone驅動可以識別的控制消息，然后通過WIFI傳輸給AR.Drone飛行控制器實現控制；針對Pixhawk飛控同樣把接口的邏輯控制信息轉化為mavlink消息再發給Pixhawk飛行控制器；針對ASCTEC的飛控也需要把邏輯控制信息轉化為ASCTEC驅動可以識別的消息再發送給飛行控制器。
[0009]更進一步，所述機器人操作系統ROS還包括用戶交互界面，用于讓用戶去選擇需要連接的飛控類型。
[0010]本發明的有益效果主要表現在:具有良好的擴展性和通用性。
【附圖說明】
[0011]圖1是通用的無人機視覺仿真平臺的原理框圖。
【具體實施方式】
[0012]下面結合附圖對本發明作進一步描述。
[0013]參照圖1，一種通用的無人機視覺仿真平臺，包括仿真環境部分和真實環境部分，所述仿真環境部分包括機器人操作系統ROS、開源的機器人仿真平臺模塊Gazebo、視覺算法庫和用于把ROS系統傳過來的信息轉換成不同飛控能識別的控制信息的通用無人機連接接口，所述通用無人機連接接口支持ROS系統，所述開源的機器人仿真平臺模塊Gazebo、視覺算法庫和通用無人機連接接口均與機器人操作系統ROS連接；所述真實環境部分包括飛行器機架和飛行控制器，所述通用無人機連接接口與所述飛行控制器連接。
[0014]進一步，所述通用無人機連接接口中，輸入端是ROS系統傳入的邏輯層控制信息，獲取到邏輯層控制信息后，在準備發送給無人機的飛控之前需要進行數據的預處理，對控制信息針對某個飛控進行轉化后發給飛行控制器。
[0015]本實施例的平臺可以支持多種無人機飛控比如AR.Drone 2.0，pixhawk，APM等等。而且可以支持多種目前國際上較為先進的視覺算法來自動控制無人機，比如OpenTLD，ORB-SLAM 等。
[0016]本實施例的仿真平臺總體是基于ROS系統和Gazebo組成，Gazebo是目前較為流行的
[0017]開源仿真軟件針對機器人仿真設計。而ROS系統也是目前世界上公認的最好的功能最全的開源機器人操作系統。
[0018]在Gazebo中首先設計好一套模擬無人機的環境，包括多種模擬的三維場景，無人機飛行器的模型，無人機的運動學動力學模型，摩擦碰撞模型和各種傳感器仿真等。
[0019]然后在Gazebo中把模擬無人機在場景中獲取的圖像信息傳輸給ROS系統，視覺算法模塊再從ROS系統中獲取圖像的輸入，然后進行相應地運算，得出的結果在反饋給R0S，ROS把結果處理轉換成控制信息發給Gazebo中的模擬飛行器，這樣就實現了視覺算法控制模擬飛行器的流程。
[0020]通用無人機連接接口，必須要支持ROS系統，在接口設計上與仿真系統連接的層面只需設計好與ROS通信的接口即可，算法層和仿真系統中運動模型或者動力學模型都會與ROS進行通信。
[0021]與真機環境中的連接設計較為復雜，需要設計一種通用接口把ROS系統傳過來的信息轉換成不同飛控能識別的控制信息，比如與pixhawk通信需要使用mavros驅動，也就是mavlink和ROS的通信連接件。再比如AR.Drone由于官方提供ROS版本的驅動，可以直接與ROS通信，所以只需在通用接口中添加即可。
[0022]最后需要設計一個與用戶交互的界面，可以讓用戶去選擇需要連接的飛控類型，一旦選擇完畢即可讓視覺控制算法無縫應用在特定的飛控上，使特定的無人機執行一些基于視覺的任務。
[0023]通用無人機連接接口的工作流程:
[0024]I)首先接口的輸入端是ROS系統傳入的邏輯層控制信息，邏輯上對不同無人機的控制是沒有區別的，都是前后左右上下旋轉等變化。
[0025]2)然后是接口獲取到邏輯層控制信息后，在準備發送給無人機的飛控之前需要進行數據的預處理，對控制信息針對某個飛控進行特殊轉化:針對AR.Drone的飛控需要把邏輯的上下左右控制轉化為AR.Drone驅動可以識別的控制消息，然后通過WIFI傳輸給AR.Drone飛控實現控制；又比如針對Pixhawk飛控同樣把接口的邏輯控制信息轉化為mavlink消息再發給Pixhawk飛控；針對ASCTEC的飛控也需要把邏輯控制信息轉化為ASCTEC驅動可以識別的消息，然后發給飛行控制器。
[0026]特別地，對于pixhawk或者APM的飛控由于其通用性較強，所以可以搭載到不同尺寸的無人機機架上，實現機架上的擴展。
[0027]以無人機跟蹤為例，使用的飛機模型為AR.Drone，使用OpenTLD視覺跟蹤算法，本實施例的平臺運作的主要流程:
[0028]I)首先是仿真模塊和真實模塊的是相對獨立的。
[0029]2)先從仿真模塊開始，在Gazebo中有事先設計好的無人機模型，包括幾何學模型和運動學模型，這些準備就緒后可以在Gazebo算法去控制無人機，同樣的也可以在Gazebo中去獲取當前無人機的各種姿態ig息。
[0030]3)當Gazebo獲取飛行器當前視角的圖像數據后，通過ROS系統獲取圖像信息，并把信息傳給計算機視覺處理模塊，然后在模塊中進行算法處理，再把處理后的結果傳輸給ROS系統，通過ROS轉換控制信息給Gazebo，讓模型飛行器在Gazebo完成相應的動作。
[0031]4)在視覺算法層進行算法處理之后，我們還能把控制信息通過ROS系統轉化為真機中能識別的信息，而這個需要ROS系統和各種飛控的接口，一般較為通用的飛控官方便會提供ROS版本的驅動，比如AR.Drone等等。而我們做的是把和ROS系統相連的一系列飛控進行整合，然后建立一個通用的接口，利用這個接口可以把ROS系統和許多種飛控進行。
[0032]5)在真實環境的測試中，采用mavros作為ROS系統與mavlink通用協議的轉換組件。飛行器上的飛行控制模塊通過mavlink協議和PC端的ROS系統進行通訊。這樣，在ROS中測試過的視覺算法就可以和真實飛行器進行交互。經過仿真測試之后的視覺算法可以非常方便地應用到實際飛行器的測試中來，提高了算法測試的安全性和高效性。
【主權項】
1.一種通用的無人機視覺仿真平臺，其特征在于:所述仿真平臺包括仿真環境部分和真實環境部分，所述仿真環境部分包括機器人操作系統ROS、開源的機器人仿真平臺模塊Gazebo、視覺算法庫和用于把ROS系統傳過來的信息轉換成不同飛控能識別的控制信息的通用無人機連接接口，所述通用無人機連接接口支持ROS系統，所述開源的機器人仿真平臺模塊Gazebo、視覺算法庫和通用無人機連接接口均與機器人操作系統ROS連接；所述真實環境部分包括飛行器機架和飛行控制器，所述通用無人機連接接口與所述飛行控制器連接。2.如權利要求1所述的一種通用的無人機視覺仿真平臺，其特征在于:所述通用無人機連接接口中，輸入端是ROS系統傳入的邏輯層控制信息，獲取到邏輯層控制信息后，在準備發送給無人機的飛控之前需要進行數據的預處理，對控制信息針對某個飛控進行轉化后發給飛行控制器。3.如權利要求2所述的一種通用的無人機視覺仿真平臺，其特征在于:所述轉化的過程如下: 針對AR.Drone的飛控需要把邏輯的上下左右控制轉化為AR.Drone驅動可以識別的控制消息，然后通過WIFI傳輸給AR.Drone飛行控制器實現控制； 針對Pixhawk飛控同樣把接口的邏輯控制信息轉化為mavlink消息再發給Pixhawk飛行控制器； 針對ASCTEC的飛控也需要把邏輯控制信息轉化為ASCTEC驅動可以識別的消息再發送給飛行控制器。4.如權利要求1?3之一所述的一種通用的無人機視覺仿真平臺，其特征在于:所述機器人操作系統ROS還包括用戶交互界面，用于讓用戶去選擇需要連接的飛控類型。
【專利摘要】一種通用的無人機視覺仿真平臺，包括仿真環境部分和真實環境部分，所述仿真環境部分包括機器人操作系統ROS、開源的機器人仿真平臺模塊Gazebo、視覺算法庫和用于把ROS系統傳過來的信息轉換成不同飛控能識別的控制信息的通用無人機連接接口，所述通用無人機連接接口支持ROS系統，所述開源的機器人仿真平臺模塊Gazebo、視覺算法庫和通用無人機連接接口均與機器人操作系統ROS連接；所述真實環境部分包括飛行器機架和飛行控制器，所述通用無人機連接接口與所述飛行控制器連接。本發明提供一種具有良好的擴展性和通用性的無人機視覺仿真平臺。
【IPC分類】G05B17/02
【公開號】CN104950695
【申請號】CN201510415014
【發明人】張劍華, 萬富華, 步青, 謝榛, 鄒祎杰, 劉盛, 陳勝勇
【申請人】浙江工業大學
【公開日】2015年9月30日
【申請日】2015年7月15日