[发明专利]无人机定位降落方法、装置、存储介质以及电子设备有效
申请号: | 202111061251.7 | 申请日: | 2021-09-10 |
公开(公告)号: | CN113821043B | 公开(公告)日: | 2023-04-11 |
发明(设计)人: | 李勇;潘屹峰;黄吴蒙;王丹;谢志杰;周成虎 | 申请(专利权)人: | 佛山中科云图智能科技有限公司 |
主分类号: | G05D1/06 | 分类号: | G05D1/06 |
代理公司: | 广州骏思知识产权代理有限公司 44425 | 代理人: | 潘桂生 |
地址: | 528251 广东省佛山市南*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 无人机 定位 降落 方法 装置 存储 介质 以及 电子设备 | ||
1.一种无人机定位降落方法,其特征在于,应用于无人机,在所述无人机的目标降落中心点的周围架设有UWB集群,所述UWB集群包括多个UWB基站,在所述无人机上设置有UWB标签,所述方法包括如下步骤:
获取每个所述UWB基站与所述UWB标签之间的空间距离;
根据所述空间距离计算出所述无人机相对于所述目标降落中心点的偏移量;其中,根据所述空间距离确定所述无人机的空间坐标,根据所述无人机的空间坐标以及所述目标降落中心点的坐标,计算出所述无人机相对于所述目标降落中心点的偏移量;
获取所述无人机相对于所述UWB基站的飞行高度;
根据所述飞行高度,对所述偏移量进行修正;其中,根据所述飞行高度,采用内置的偏移量修正方法,对所述偏移量进行修正;
根据修正后的偏移量,控制无人机降落至所述目标降落中心点;其中,根据所述修正后的偏移量和额定发送频率,计算出所述无人机的移动速度;其中,所述额定发送频率为将所述偏移量发送给无人机飞行控制器的固定频率;根据计算出的移动速度和无人机实际输出的移动速度,调整所述无人机的降落位置,使无人机降落至所述目标降落中心点。
2.根据权利要求1所述的无人机定位降落方法,其特征在于,所述获取每个所述UWB基站与所述UWB标签之间的空间距离,包括:
控制所述UWB标签按照预设的频率发送脉冲信号;
根据所述无人机上的UWB标签发送所述脉冲信号和接收所述每个UWB基站发出的响应信号的第一时差、所述每个UWB基站接收所述脉冲信号和发出的所述响应信号的第二时差,计算所述每个UWB基站与所述UWB标签之间的空间距离。
3.根据权利要求2所述的无人机定位降落方法,其特征在于,所述根据所述无人机上的UWB标签发送所述脉冲信号和接收所述每个UWB基站发出的响应信号的第一时差、所述每个UWB基站接收所述脉冲信号和发出的所述响应信号的第二时差,计算所述每个UWB基站与所述UWB标签之间的空间距离,包括:
获取所述无人机上的UWB标签发送所述脉冲信号和接收所述每个UWB基站发出的响应信号的第一时差、所述每个UWB基站接收所述脉冲信号和发出的所述响应信号的第二时差以及所述脉冲信号的传播速率;
根据所述第一时差、所述第二时差以及所述脉冲信号的传播速率,计算所述每个UWB基站与所述UWB标签之间的空间距离;其中,所述空间距离的计算公式为:
L=(T1-T2)*C/2
L为所述空间距离,T1为所述第一时差,T2为所述第二时差,C为所述脉冲信号的传播速率。
4.根据权利要求1所述的无人机定位降落方法,其特征在于,所述UWB集群包括4个UWB基站,所述4个UWB基站位于预设的正方形的四个顶点上,所述无人机的目标降落中心点位于所述正方形的对角线中心。
5.根据权利要求4所述的无人机定位降落方法,其特征在于,所述根据所述空间距离计算出所述无人机相对于所述目标降落中心点的偏移量,包括:
获取每个UWB基站与所述目标降落中心点之间的水平距离和竖直距离;
在所述UWB基站所在的平面,以所述UWB基站所在的正方形的两个相邻边为X轴和Y轴,以所述平面的法线方向为Z轴,建立空间坐标系,获得每个UWB基站的空间坐标;
根据所述空间距离和每个UWB基站的空间坐标,计算出所述无人机的空间坐标;
根据所述水平距离、所述竖直距离以及所述无人机的空间坐标,计算出所述无人机相对于所述目标降落中心点的偏移量。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于佛山中科云图智能科技有限公司,未经佛山中科云图智能科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111061251.7/1.html,转载请声明来源钻瓜专利网。