[发明专利]一种行进物体避障方法及装置在审
申请号: | 202110607033.2 | 申请日: | 2021-06-01 |
公开(公告)号: | CN113341967A | 公开(公告)日: | 2021-09-03 |
发明(设计)人: | 刘宇航;张斌;魏慧;许诺 | 申请(专利权)人: | 北京机械设备研究所 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 北京云科知识产权代理事务所(特殊普通合伙) 11483 | 代理人: | 张飙 |
地址: | 100854 北京市海淀区永*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 行进 物体 方法 装置 | ||
本申请揭示了一种行进物体避障方法及装置,该方法包括:在行进物体的工作模式为非避障模式时,调整进行物体的航向;在航向与朝向目标位置的设定方向相同且存在障碍物,则从当前的航向随机调整角度和/或位置,根据调整后的朝向计算当前航向,根据当前航向控制行进物体朝向目标位置前进,将行进物体的工作模式修改为避障模式,随机生成避障步数。本申请通过实时判断预定距离内是否存在障碍物,在存在障碍物时,自动调整角度和/或位置,根据调整后的航向朝目标位置前进,解决了因需要预先绘制环境障碍物地图导致实现复杂,适应性较差的问题,由于无需预先绘制环境障碍物地图,因此可以适应任何环境空间,实现简单,环境适应性较好。
技术领域
本发明属于计算机技术领域,涉及一种行进物体避障方法及装置。
背景技术
避障是指物体在运动过程中自主躲避障碍以避免发生预期之外的碰撞或事故的行为。避障在机器人(包括空中、地面、水面和水下等不同应用场景)运动控制领域中具有重要意义,是实现自主运动控制的先决条件。
常见的一种避障方式时记录并存储行进物体的运动轨迹,预先建立行进所在环境空间的障碍物信息绘制地图,行进物体根据绘制的地址避开障碍物。由于需要预先建立环境空间的障碍物地图,因此实现复杂,适应性较差。
发明内容
为了解决相关技术的问题,本申请提供了一种行进物体避障方法及装置,技术方案如下:
第一方面,本申请提供了一种行进物体避障方法,所述方法包括:
获取所述行进物体的工作模式;
若所述行进物体的工作模式为非避障模式,则调整所述进行物体的航向,得到当前航向;
判断所述当前航向与朝向目标位置的设定方向是否相同;
在所述航向与朝向目标位置的设定方向相同时,判断所述行进物体沿当前的航向在预定距离内是否存在障碍物;
若所述行进物体沿当前的前进方向在预定距离内存在障碍物,从当前的航向随机调整角度和/或位置,根据调整后的角度和/或位置后的朝向计算当前航向,根据所述当前航向控制所述行进物体朝向目标位置前进,将所述行进物体的工作模式修改为避障模式,随机生成避障步数。
可选地,在所述获取所述行进物体的工作模式之后,所述方法还包括:
若所述行进物体的工作模式为避障模式,获取避障步数;
若所述避障步数大于0,执行所述判断所述当前航向与朝向目标位置的设定方向是否相同的步骤;
若所述避障步数等于0,则将所述行进物体的工作模式修改为非避障模式。
可选地,所述从当前的航向随机调整角度和/或位置,包括:
从当前的航向沿顺时针或逆时针随机旋转一个角度;和/或,向上或向下随机移动一段距离。
可选地,在所述判断所述行进物体沿当前的航向在预定距离内是否存在障碍物之后,所述方法还包括:
若所述行进物体沿当前的航向在预定距离内不存在障碍物,判断行进物体的工作模式是否为避障模式;
若所述行进物体的工作模式为避障模式,移动预定距离,将所述避障步数减1;
若所述行进物体的工作模式为非避障模式,移动预定距离,执行结束行程的判定。
可选地,所述执行结束行程的判定,包括:
判断是否达到目标位置;
若达到目标位置,则结束行进过程;
若未达到目标位置,则继续执行所述获取所述行进物体的工作模式的步骤。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京机械设备研究所,未经北京机械设备研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110607033.2/2.html,转载请声明来源钻瓜专利网。
- 上一篇:一种基于配电物联网关的自动恢复供电方法
- 下一篇:一种自洁式无菌贮水罐