CN108544491B - 一种综合考虑距离与方向两因素的移动机器人避障方法 - Google Patents
一种综合考虑距离与方向两因素的移动机器人避障方法 Download PDFInfo
- Publication number
- CN108544491B CN108544491B CN201810289260.3A CN201810289260A CN108544491B CN 108544491 B CN108544491 B CN 108544491B CN 201810289260 A CN201810289260 A CN 201810289260A CN 108544491 B CN108544491 B CN 108544491B
- Authority
- CN
- China
- Prior art keywords
- robot
- obstacle
- distance
- measurement value
- calculating
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开一种综合考虑距离与方向两个因素的移动机器人避障方法。该方法将障碍物的距离和方向之间的融合问题数值化,获得一个统一的衡量标准,称为障碍物危险度值。最大危险度值的障碍物获得优先避障,该方法能使移动机器人根据实时的环境信息自然平滑地调整运动的角速度和线速度,为机器人提供了距离和方向两方面的安全保障,对于机器人的安全导航具有实用意义。
Description
技术领域
本发明属于移动机器人障碍物避让控制***领域,特别的,涉及一种基于激光测距传感器的移动机器人避障方法。
背景技术
近年来,机器人及智能车辆在战场攻防、抢险救灾、科学探索等人类不能到达或高度危险性的环境中体现出越来越重要的应用。随着机器人技术的发展,促进了机器人应用领域的不断扩展,机器人的工作环境也随之越来越复杂。机器人在运动过程中会遇到各种各样的障碍物,这就导致机器人在其导航运动过程中存在着极大的安全危险。因此是否具备快速有效的规避障碍物能力是机器人实现安全导航的关键。目前在大部分避障方法中,通常主要考虑障碍物与机器人之间的距离来进行避障运算。这种方法减弱了障碍物的方位信息对机器人避障的影响。距离和方向是机器人对障碍物进行避障评判的两个主要评价指标,距离近的应优先避障,前方的障碍物也应该优先避障。为此,提出了一种融合了距离和方向的基于激光雷达传感器的移动机器人避障方法,对于机器人的安全导航提供了更多的安全保障,对于机器人的安全导航具有实用意义。
发明内容
本发明针对现有方法的不足,提出一种综合考虑距离和方位两因素的基于激光测距传感器的移动机器人避障方法。
为了达到上述目的,本发明分成三个部分:第一部分为移动机器人自身周围局部环境信息的获取部分;第二部分为综合考虑距离和方位两个因素的危险障碍物提取,第三部分为基于障碍物危险度的移动机器人避障。
避障方法的运行步骤如下:
一:局部环境信息的获取
步骤1:通过背靠背安装两部激光测距仪来扫描机器人的周围环境,形成一个360°的圆形扫描面。每一次扫描可获得一帧扫描数据,表示为数组Ak
二:计算综合考虑距离和方位两个因素的障碍物危险度
步骤3:计算临时变量S
S=max(0.56yi+2.56,0) (4)
步骤4:计算临时变量K
K=max(yi+0.56,eps),其中eps=0.00001 (5)
步骤5:计算ri
ri=max(1-(yi 2+Sxi 2)/K,0) 1≤i≤N (6)
ri即为第i个距离测量值所对应的融合了距离与方向的障碍物危险度值,且0≤ri≤1。如果ri=1,表示第i个距离测量值所对应的障碍物危险度最高,ri=0表示第i个距离测量值所对应的障碍物没有危险。
步骤6:如果i≤N,则回到步骤2直到获得含有N个元素的危险度值数组
R={r1,r2,…,rN} (7)
三:基于障碍物危险度的移动机器人避障
步骤9:通过公式(10)、(11)计算机器人进行避障运动的角速度ω与线速度v表示如下:
其中ωpre与vpre为切换到避障行为时机器人的角速度与线速度;ωmax与vmax为机器人最大角速度与线速度;α与β为强度因子。
步骤10:跳转到步骤1继续运行,直到机器人完成运动任务。
有益效果:本发明通过对将距离与方向的信息进行数据融合,形成一个单一的衡量标准,即为障碍物危险度值。具有计算复杂度低和实时性好的特点。该设计能使移动机器人根据实时的环境信息自然平滑地调整运动的角速度和线速度,从而可以确保机器人实现更为安全的导航控制。
附图说明
图1为移动机器人避障方法的流程框图;
图2为移动机器人避障方法的实施过程中的运动截图。
具体实施方式:
本发明随着机器人在环境中运动,同时运用激光测距仪的采集机器人周围的局部环境信息,综合考虑环境信息的距离和方位获得一个单一的衡量标准,即障碍物危险度值,机器人根据危险度值生成合适的避障线速度和角速度,完成避障行为。图2为移动机器人避障方法实施过程中的运动截图。从运动轨迹可见,机器人成功的避开障碍物从起点到达终点。
如图1所示,以下举例说明本发明整个过程的具体实施方式:
第一部分:局部环境信息的获取
步骤1:通过背靠背安装两部激光测距仪来扫描机器人的周围环境,形成一个360°的圆形扫描面。每一次扫描可获得一帧扫描数据,第k次扫描周围环境获得的数组Ak
第二部分:计算综合考虑距离和方位两个因素的障碍物危险度
xi=dicos(i·1) (2)
yi=disin(i·1) (3)
步骤3:计算临时变量S
S=max(0.56yi+2.56,0) (4)
步骤4:计算临时变量K
K=max(yi+0.56,eps),其中eps=0.00001 (5)
步骤5:计算ri
ri=max(1-(yi 2+Sxi 2)/K,0)(1≤i≤N) (6)
ri即为第i个距离测量值所对应的障碍物的危险度,且0≤ri≤1。如果ri=1,表示第i个距离测量值所对应的障碍物危险度最高,ri=0表示第i个距离测量值所对应的障碍物没有危险。
步骤6:如果i≤N,则回到步骤2直到获得含有N=360个元素的危险度值数组
R={r1,r2,…,rN} (7)
第三部分:基于障碍物危险度的移动机器人避障
步骤9:通过公式(10)(11)计算机器人进行避障运动的角速度ω与线速度v表示如下:
其中ωpre与vpre为切换到避障行为时机器人的角速度与线速度;ωmax与vmax为机器人最大角速度与线速度;α与β为强度因子,设置α=2,β=4。
步骤10:跳转到步骤1继续运行,直到机器人完成运动任务。
Claims (1)
1.一种综合考虑距离与方向两因素的移动机器人避障方法,其特征在于,该方法具体包括以下步骤:
一:局部环境信息的获取
步骤1:通过背靠背安装两部激光测距仪来扫描机器人的周围环境,形成一个360°的圆形扫描面;每一次扫描可获得一帧扫描数据,表示为数组Ak
二:计算综合考虑距离和方位两个因素的障碍物危险度
步骤3:计算临时变量S
S=max(0.56yi+2.56,0) (4)
步骤4:计算临时变量K
K=max(yi+0.56,eps),其中eps=0.00001 (5)
步骤5:计算ri
ri=max(1-(yi 2+Sxi 2)/K,0) 1≤i≤N (6)
ri即为第i个距离测量值所对应的融合了距离与方向的障碍物危险度值,且0≤ri≤1;如果ri=1,表示第i个距离测量值所对应的障碍物危险度最高,ri=0表示第i个距离测量值所对应的障碍物没有危险;
步骤6:如果i≤N,则回到步骤2直到获得含有N个元素的危险度值数组
R={r1,r2,…,rN} (7)
三:基于障碍物危险度的移动机器人避障
步骤9:通过公式(10)、(11)计算机器人进行避障运动的角速度ω与线速度v表示如下:
其中ωpre与vpre为切换到避障行为时机器人的角速度与线速度;ωmax与vmax为机器人最大角速度与线速度;α与β为强度因子;
步骤10:跳转到步骤1继续运行,直到机器人完成运动任务。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810289260.3A CN108544491B (zh) | 2018-03-30 | 2018-03-30 | 一种综合考虑距离与方向两因素的移动机器人避障方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810289260.3A CN108544491B (zh) | 2018-03-30 | 2018-03-30 | 一种综合考虑距离与方向两因素的移动机器人避障方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108544491A CN108544491A (zh) | 2018-09-18 |
CN108544491B true CN108544491B (zh) | 2020-04-28 |
Family
ID=63513931
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810289260.3A Active CN108544491B (zh) | 2018-03-30 | 2018-03-30 | 一种综合考虑距离与方向两因素的移动机器人避障方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108544491B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110147108B (zh) * | 2019-06-04 | 2021-08-03 | 西南交通大学 | 一种基于膜计算的移动机器人避障控制方法 |
CN113110413B (zh) * | 2021-03-10 | 2022-11-08 | 成都永奉科技有限公司 | 跟随机器人以及跟随控制方法、跟随控制*** |
CN113069094A (zh) * | 2021-03-22 | 2021-07-06 | 浙江华彩光电科技有限公司 | 一种兼备防爆异常检测以及生理预警功能的佩戴式用具 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102541057A (zh) * | 2010-12-29 | 2012-07-04 | 沈阳新松机器人自动化股份有限公司 | 一种基于激光测距仪的移动机器人避障方法 |
CN102773858A (zh) * | 2012-07-17 | 2012-11-14 | 北京航空航天大学 | 一种码垛机器人的避障方法 |
CN105159291A (zh) * | 2015-07-10 | 2015-12-16 | 北京印刷学院 | 一种基于信息物理网的车队智能避障装置及避障方法 |
CN105437232A (zh) * | 2016-01-11 | 2016-03-30 | 湖南拓视觉信息技术有限公司 | 一种控制多关节移动机器人避障的方法及装置 |
CN106166750A (zh) * | 2016-09-27 | 2016-11-30 | 北京邮电大学 | 一种改进型d*机械臂动态避障路径规划方法 |
CN107844116A (zh) * | 2017-10-12 | 2018-03-27 | 杭州电子科技大学 | 一种移动机器人路径地图在线生成方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
AT502286B1 (de) * | 2004-09-15 | 2008-09-15 | Wfl Millturn Tech Gmbh & Co Kg | Verfahren zur kollisionsvermeidung |
-
2018
- 2018-03-30 CN CN201810289260.3A patent/CN108544491B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102541057A (zh) * | 2010-12-29 | 2012-07-04 | 沈阳新松机器人自动化股份有限公司 | 一种基于激光测距仪的移动机器人避障方法 |
CN102773858A (zh) * | 2012-07-17 | 2012-11-14 | 北京航空航天大学 | 一种码垛机器人的避障方法 |
CN105159291A (zh) * | 2015-07-10 | 2015-12-16 | 北京印刷学院 | 一种基于信息物理网的车队智能避障装置及避障方法 |
CN105437232A (zh) * | 2016-01-11 | 2016-03-30 | 湖南拓视觉信息技术有限公司 | 一种控制多关节移动机器人避障的方法及装置 |
CN106166750A (zh) * | 2016-09-27 | 2016-11-30 | 北京邮电大学 | 一种改进型d*机械臂动态避障路径规划方法 |
CN107844116A (zh) * | 2017-10-12 | 2018-03-27 | 杭州电子科技大学 | 一种移动机器人路径地图在线生成方法 |
Non-Patent Citations (2)
Title |
---|
Continuous learning route map for robot navigation using a growing-on-demand self-organizing neural network;Zhong CL;《INTERNATIONAL JOURNAL OF ADVANCED ROBOTIC SYSTEMS》;20171023;第14卷(第6期);全文 * |
未知环境下的移动机器人主动寻径导航策略;仲朝亮;《杭州电子科技大学学报》;20081231;第20卷(第6期);第99-102页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108544491A (zh) | 2018-09-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110645974B (zh) | 一种融合多传感器的移动机器人室内地图构建方法 | |
US10436884B2 (en) | Calibration of laser and vision sensors | |
CN107239076B (zh) | 基于虚拟扫描与测距匹配的agv激光slam方法 | |
CN108544491B (zh) | 一种综合考虑距离与方向两因素的移动机器人避障方法 | |
Ghorpade et al. | Obstacle detection and avoidance algorithm for autonomous mobile robot using 2D LiDAR | |
US10131446B1 (en) | Addressing multiple time around (MTA) ambiguities, particularly for lidar systems, and particularly for autonomous aircraft | |
CN108844538B (zh) | 一种基于视觉/惯导的无人机避障航点生成方法 | |
Fareh et al. | Enhancing path quality of real-time path planning algorithms for mobile robots: A sequential linear paths approach | |
CN110889808A (zh) | 一种定位的方法、装置、设备及存储介质 | |
KR20150136209A (ko) | 다중 영상 기반 장애물 회피 시스템 및 방법 | |
CN113108791A (zh) | 一种导航定位方法及导航定位设备 | |
CN113587930B (zh) | 基于多传感融合的自主移动机器人室内外导航方法及装置 | |
US11067676B2 (en) | Lidar intensity calibration | |
KR20200095379A (ko) | 자체적으로 생성된 정보 및 다른 개체에 의해 생성된 정보를 선택적으로 사용하여 카메라의 오정렬을 보정하는 방법 및 이를 이용한 장치 | |
RU2661964C2 (ru) | Способ автоматического формирования гладких траекторий движения мобильного робота в неизвестном окружении | |
Kim | Control laws to avoid collision with three dimensional obstacles using sensors | |
CN110673627A (zh) | 一种森林无人机搜寻方法 | |
Sonali et al. | Obstacle avoidance for a mobile exploration robot using a single ultrasonic range sensor | |
US20200189120A1 (en) | Collaborative Task Execution With Humans And Robotic Vehicles | |
CN107479561B (zh) | 一种控制机器人的方法 | |
Deng et al. | Research on target recognition and path planning for EOD robot | |
Han et al. | Optimization‐based humanoid robot navigation using monocular camera within indoor environment | |
Clark et al. | Proportional navigation based guidance laws for UAV obstacle avoidance in complex urban environments | |
Cheng et al. | Integration of active and passive sensors for obstacle avoidance | |
Hoang et al. | Proposal of algorithms for navigation and obstacles avoidance of autonomous mobile robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |