[實用新型]一種用于無人機自動降落的地表面識別裝置

有效

• 申請號: 201621361346.5
• 申請日: 2016-12-13
• 公開（公告）號: CN206311971U
• 公開（公告）日: 2017-07-07
• 發明（設計）人: 李高宇;羅曉曙;符可鵬
• 申請（專利權）人: 廣西師范大學
• 主分類號: G05D1/08
• 分類號: G05D1/08
• 代理公司: 桂林市華杰專利商標事務所有限責任公司45112
• 代理人: 劉梅芳

技術領域

本實用新型涉及控制領域，特別是涉及一種用于無人機自動降落的地表面識別裝置 。

背景技術

近幾年，無人機的發展勢頭十分猛烈，市場的需求也越來越大。軍事、工業、農業以及消費類無人機開始廣泛運用。然而目前無人機降落的方式大多是水平垂直降落，此種降落方式在傾斜的地面降落容易造成槳葉撞擊地面毀壞無人機，在降落方面是一個不可忽視的問題。由此可見無人機降落時對降落地表面相對水平面的姿態識別十分重要。

因此需要為無人機設計一種能夠自動識別地面，能根據地面的狀況進一步調節槳葉，從而使得無人機在任何一種地形降落都不會損壞到槳葉。

實用新型內容

針對上述存在的不足，本實用新型提供一種用于無人機自動降落的地表面識別裝置 。

本實用新型通過以下技術方案解決上述問題：

一種用于無人機自動降落的地表面識別裝置，包括三軸陀螺儀傳感器、三軸加速度傳感器、三軸磁場傳感器、超聲波測距模塊、卡爾曼濾波電路Ⅲ、IIR濾波電路、卡爾曼濾波電路Ⅰ、溫度補償電路、卡爾曼濾波電路Ⅱ、機體平衡分析電路、地表面分析電路、機體相對地面分析電路和輸出端口電路；

所述三軸陀螺儀傳感器的輸出端與卡爾曼濾波電路Ⅲ連接；所述三軸加速度傳感器的輸出端與IIR濾波電路連接；所述三軸磁場傳感器的輸出端與卡爾曼濾波電路Ⅰ連接；所述超聲波測距模塊的輸出端經溫度補償電路與卡爾曼濾波電路Ⅱ連接；所述卡爾曼濾波電路Ⅲ和IIR濾波電路的輸出端均與機體平衡分析電路連接；所述卡爾曼濾波電路Ⅰ的輸出端分別與機體平衡分析電路和機體相對地面分析電路連接；所述卡爾曼濾波電路Ⅱ的輸出端與機體相對地面分析電路連接；所述機體平衡分析電路和機體相對地面分析電路的輸出端均與地表面分析電路連接；所述地表面分析電路的輸出端與輸出端口電路連接；所述輸出端口電路與無人機的控制器連接。

上述方案中，優選的是超聲波測距模塊包括四個超聲波傳感器和一塊正方形或長方形的電路板，所述四個超聲波傳感器分別安裝在電路板的四個角上。

上述方案中，優選的是輸出端口電路為串口輸出電路和I2C輸出電路。

上述方案中，優選的是IIR濾波電路使用IIR低通濾波器。

本實用新型的優點與效果是：

本實用新型提供一種用于無人機自動降落的地表面識別裝置，通過三軸陀螺儀、三軸加速度傳感器和三軸磁場傳感器測量確定裝置機體相對水平面的姿態，測距模塊測量裝置機體相對低表面的距離從而確定裝置相對地表面的姿態；根據裝置機體相對水平面的姿態和裝置機體相對地表面的姿態可以確定地表面相對水平面的姿態；該裝置裝在無人機上，測量出的地表面相對水平面姿態數據和裝置機體相對水平面姿態數據通過接口傳輸至無人機控制系統，以便無人機根據地表面姿態做出相應的降落姿勢。

附圖說明

圖1為本實用新型結構框圖。

具體實施方式

以下結合實施例對本實用新型作進一步說明。

一種用于無人機自動降落的地表面識別裝置，如圖1所示，包括三軸陀螺儀傳感器、三軸加速度傳感器、三軸磁場傳感器、超聲波測距模塊、卡爾曼濾波電路Ⅲ、IIR濾波電路、卡爾曼濾波電路Ⅰ、溫度補償電路、卡爾曼濾波電路Ⅱ、機體平衡分析電路、地表面分析電路、機體相對地面分析電路和輸出端口電路。其中，卡爾曼濾波電路Ⅲ、IIR濾波電路、卡爾曼濾波電路Ⅰ、溫度補償電路、卡爾曼濾波電路Ⅱ、機體平衡分析電路、地表面分析電路和機體相對地面分析電路為處理器的內部結構電路，處理器使用型號為STM32系列的單片機芯片或DSP的處理器。

三軸陀螺儀傳感器的輸出端與卡爾曼濾波電路Ⅲ連接，三軸陀螺儀用于測量裝置的橫滾、俯仰和偏航角速度。三軸加速度傳感器的輸出端與IIR濾波電路連接，三軸加速度傳感器用于測量重力在裝置坐標軸的分量。三軸磁場傳感器的輸出端與卡爾曼濾波電路Ⅰ連接，三軸磁場傳感器測量裝置的偏航角。超聲波測距模塊的輸出端經溫度補償電路與卡爾曼濾波電路Ⅱ連接，超聲波測距模塊用于測量裝置機體到地表面的距離。