[发明专利]控制无人机避障的方法、装置、存储介质及无人机有效
申请号: | 202110502111.2 | 申请日: | 2021-05-08 |
公开(公告)号: | CN113110594B | 公开(公告)日: | 2022-05-17 |
发明(设计)人: | 刘长江;郭彦杰 | 申请(专利权)人: | 北京三快在线科技有限公司 |
主分类号: | G05D1/10 | 分类号: | G05D1/10 |
代理公司: | 北京英创嘉友知识产权代理事务所(普通合伙) 11447 | 代理人: | 张岩龙 |
地址: | 100190 北京市海*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 控制 无人机 方法 装置 存储 介质 | ||
本公开涉及一种控制无人机避障的方法、装置、存储介质及无人机,在当前周期内获取位于无人机对应的第一预设危险区域内的多个目标点的位置信息,所述目标点为位于第一预设危险区域内的障碍物的位置点;将第一预设危险区域按照预设间隔距离划分为多个危险子区域;根据所述位置信息和预设间隔距离确定每个危险子区域对应的目标点参数,目标点参数包括第一目标点距离和位于该危险子区域中的目标点的目标数量,第一目标点距离包括指定目标点与无人机的距离,指定目标点为位于该危险子区域中距离无人机最近的目标点;根据每个危险子区域对应的第一目标点距离和所述目标数量,确定无人机与障碍物的第一危险距离;根据第一危险距离控制无人机避障。
技术领域
本公开涉及无人机的避障领域,具体地,涉及一种控制无人机避障的方法、装置、存储介质及无人机。
背景技术
在诸如无人车/无人机/机器人等各类无人系统中,都需要通过各种传感器来对周围环境进行感知,给出无人系统相对障碍物的相对位置关系,用于避障或是路径规划决策,目前主要采用安装在无人机上的毫米波雷达通过发射/接收目标回波,感知在预设方向上特定空间范围内的障碍物的信息,并输出一个与无人机最近的纵向距离作为危险距离,当该危险距离小于预设值时,无人机可以执行诸如停飞/限速等操作,以规避碰撞危险。
在危险距离计算方面,现有的策略多是由当前帧的数据计算得到一个危险距离,并利用前后帧的危险距离进行平滑,这样可以减小高度输出的误差,同时剔除一些野值,但对场景存在阶梯性变化时(可以理解为前方障碍物上的多个目标点与无人机的纵向距离不相同),现有的平滑策略通常无法做到及时的响应,从而影响确定的危险距离的准确性,进而影响无人机的飞行安全。
发明内容
本公开的目的是提供一种控制无人机避障的方法、装置、存储介质及无人机。
第一方面,提供一种控制无人机避障的方法,所述方法包括:
在当前周期内获取位于无人机对应的第一预设危险区域内的多个目标点的位置信息,所述目标点为位于所述第一预设危险区域内的障碍物的位置点;所述第一预设危险区域为位于所述无人机的飞行方向上预设距离范围内的指定宽度的区域;将所述第一预设危险区域按照预设间隔距离划分为多个危险子区域;根据所述位置信息和所述预设间隔距离确定每个危险子区域对应的目标点参数,所述目标点参数包括第一目标点距离和位于该危险子区域中的目标点的目标数量,所述第一目标点距离包括指定目标点与所述无人机的距离,所述指定目标点为位于该危险子区域中距离所述无人机最近的目标点;根据每个危险子区域对应的所述第一目标点距离和所述目标数量,确定所述无人机与所述障碍物的第一危险距离;根据所述第一危险距离控制所述无人机避障。
可选地,所述位置信息包括相对于所述无人机的纵向距离;所述根据所述位置信息和所述预设间隔距离确定每个危险子区域对应的目标点参数包括:
针对每个目标点,根据所述预设距离间隔和该目标点对应的所述纵向距离确定该目标点对应的距离标识:确定所述距离标识对应的目标危险子区域,所述目标危险子区域包括目标子区域集合中的至少一个危险子区域,所述目标子区域集合包括子区域标识与所述距离标识相同的指定危险子区域和与所述指定危险子区域相邻的危险子区域;按照第一预设调整幅度分别更新每个所述目标危险子区域对应的所述目标数量;根据该目标点对应的所述纵向距离分别更新每个所述目标危险子区域对应的当前目标点距离,得到每个所述目标危险子区域分别对应的所述第一目标点距离;在针对多个所述目标点中的每个所述目标点均更新对应的目标危险子区域的所述目标数量后,得到每个危险子区域分别对应的所述目标数量;在针对多个所述目标点中的每个所述目标点均更新对应的目标危险子区域的所述第一目标点距离后,得到每个危险子区域分别对应的所述第一目标点距离。
可选地,所述根据该目标点对应的所述纵向距离分别更新每个所述目标危险子区域对应的当前目标点距离包括:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京三快在线科技有限公司,未经北京三快在线科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110502111.2/2.html,转载请声明来源钻瓜专利网。