[發明專利]一種基于攝像頭的四旋翼飛行器跟蹤控制系統及方法

在審

• 申請號: 201810158785.3
• 申請日: 2018-02-26
• 公開（公告）號: CN108319285A
• 公開（公告）日: 2018-07-24
• 發明（設計）人: 周牡丹;劉夢婷;王碩;陳曉龍;柯家盛;葉林森
• 申請（專利權）人: 廈門大學嘉庚學院
• 主分類號: G05D1/08
• 分類號: G05D1/08;G05D1/10
• 代理公司: 福州元創專利商標代理有限公司 35100
• 代理人: 蔡學俊;薛金才

1.一種基于攝像頭的四旋翼飛行器跟蹤控制系統，其特征在于，包括第一控制器、第二控制器、高度檢測模塊、圖像采集模塊、電源模塊、電子調速器、加速度計和陀螺儀；

所述第一控制器分別與高度檢測模塊、圖像采集模塊和第二控制器連接，所述第二控制器還與電子調速器、加速度計和陀螺儀連接；電源模塊用于給四旋翼飛行器跟蹤控制系統供電；

所述第一控制器對圖像采集模塊采集到的圖像數據和高度檢測模塊檢測到的高度數據進行分析和處理，識別跟蹤目標，解析飛行器自身位置，進行高度偏差和方向偏差計算并規劃跟蹤路徑；同時將跟蹤路徑編成報文，通過串口傳輸發送至第二控制器，所述第二控制器解析報文獲取跟蹤路徑，所述加速度計和陀螺儀將采集的姿態信息發送給第二控制器，所述第二控制器通過四元數算法解析飛行器自身姿態，結合跟蹤路徑計算飛行器四旋翼上電機的控制量，通過電子調速器控制四旋翼上電機的轉動速度，實現目標跟蹤。

2.根據權利要求1所述的四旋翼飛行器跟蹤控制系統，其特征在于，還包括顯示模塊，所述顯示模塊與第一控制器連接，用于顯示飛行器的運行時間、前進路程、跟蹤目標的位置和飛行器自身位置。

3.根據權利要求1所述的四旋翼飛行器跟蹤控制系統，其特征在于，還包括鍵盤，所述鍵盤與第一控制器連接，鍵盤包括啟動、復位、停止和調試功能鍵。

4.根據權利要求1所述的四旋翼飛行器跟蹤控制系統，其特征在于，所述第一控制器型號為R5F523T5ADFM。

5.根據權利要求1所述的四旋翼飛行器跟蹤控制系統，其特征在于，所述第二控制器型號為STM32F407ZET6。

6.根據權利要求1所述的四旋翼飛行器跟蹤控制系統，其特征在于，所述圖像采集模塊包括型號為OV7725的攝像頭。

7.基于權利要求1所述的四旋翼飛行器跟蹤控制系統的控制方法，其特征在于，包括以下步驟：

步驟S1：系統設備初始化；

步驟S2：高度檢測模塊檢測飛行器當前的高度數據，發送至第一控制器，第一控制器對當前的高度數據與設定高度進行對比，計算高度偏差，通過PID控制算法調節輸出量；

步驟S3：圖像采集模塊采集圖像數據發送至第一控制器，第一控制器對獲取的圖像數據進行分析計算，識別跟蹤目標，解析飛行器自身位置，獲取當前飛行器位置與跟蹤目標的方向偏差，當跟蹤目標在飛行器的左邊時，通過PID控制算法調節橫向roll值減小，當跟蹤目標在飛行器的右邊時，通過PID控制算法調節橫向roll值增大；

步驟S4：第一控制器根據高度偏差和方向偏差規劃跟蹤路徑，同時將跟蹤路徑編成報文，通過串口傳輸發送至第二控制器；

步驟S5：第二控制器解析報文獲取跟蹤路徑，加速度計和陀螺儀將采集的姿態信息發送給第二控制器，所述第二控制器通過四元數算法解析飛行器自身姿態，結合跟蹤路徑計算飛行器四旋翼上的電機的控制量，通過電子調速器控制四旋翼上電機的轉動速度，使飛行器移動，實現目標跟蹤。

8.根據權利要求7所述的控制方法，其特征在于，所述第一控制器連接一顯示模塊，用于顯示飛行器的運行時間、前進路程、跟蹤目標的位置和飛行器自身位置。

9.根據權利要求7所述的控制方法，其特征在于，所述第一控制器連接一鍵盤，所述鍵盤包括啟動、復位、停止和調試功能鍵。