CN105538309B - 一种有限传感能力的机器人障碍物动态识别算法 - Google Patents

一种有限传感能力的机器人障碍物动态识别算法 Download PDF

Info

Publication number
CN105538309B
CN105538309B CN201510874735.1A CN201510874735A CN105538309B CN 105538309 B CN105538309 B CN 105538309B CN 201510874735 A CN201510874735 A CN 201510874735A CN 105538309 B CN105538309 B CN 105538309B
Authority
CN
China
Prior art keywords
robot
sensing capability
coordinate
virtual obstacles
limited sensing
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
Application number
CN201510874735.1A
Other languages
English (en)
Other versions
CN105538309A (zh
Inventor
李相鹏
黄海波
杨湛
陈立国
陈涛
汝长海
孙立宁
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Haibo Suzhou Robot Technology Co ltd
Original Assignee
Suzhou University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Suzhou University filed Critical Suzhou University
Priority to CN201510874735.1A priority Critical patent/CN105538309B/zh
Publication of CN105538309A publication Critical patent/CN105538309A/zh
Application granted granted Critical
Publication of CN105538309B publication Critical patent/CN105538309B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1674Programme controls characterised by safety, monitoring, diagnostic
    • B25J9/1676Avoiding 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

本发明公开了一种有限传感能力的机器人障碍物动态识别方法,其特征是,包括如下步骤:1)机器人探测真实障碍物,并计算探测范围内真实障碍物的最大宽度,得到边界点A和B,坐标分别为qA和qB;2)对步骤1)得到的两点坐标进行虚拟障碍物l(ζ);3)机器人根据步骤2)得到的虚拟障碍物l(ζ)的坐标进行绕行,并不断地进行步骤1)中的探测。本发明所达到的有益效果:本方法基于圆盘传感约束模型,模拟有限传感能力的机器人渐进障碍物探测的真实过程进行数学建模,不减小规划自由度,不降低导航控制器精度,而且能够保证在后续的导航控制器建模中避障的部分的连续性。

Description

一种有限传感能力的机器人障碍物动态识别算法
技术领域
本发明涉及一种有限传感能力的机器人障碍物动态识别方法,属于机器人避障技术领域。
背景技术
在实际应用中,机器人的通信或者传感能力通常是有限的。
对于有限传感及通信能力的机器人而言,未知障碍物的探测及识别与探测过程通常是渐进式的,即不可能瞬时探测到障碍物的全貌。在实际的导航控制器建模过程中,为了保证导航控制器的连续性并出于简化处理的目的,通常采用脱离物理实际的连续的数学假设模型来描述障碍物的识别及探测过程,或者直接将障碍物描述为一个已知大小的点来处理。
以上两种方式对未知障碍物的探测建模,均会给导航控制器建模带来不准确性或者不连续,导致机器人在导航过程中规划自由度减小,精度下降,出现碰撞风险,甚至***不稳定等问题。
发明内容
为解决现有技术的不足,本发明的目的在于提供一种有限传感能力的机器人障碍物动态识别方法,基于圆盘传感约束模型,模拟有限传感能力的机器人渐进障碍物探测的真实过程进行数学建模,不减小规划自由度,不降低导航控制器精度。
为了实现上述目标,本发明采用如下的技术方案:
一种有限传感能力的机器人障碍物动态识别方法,其特征是,包括如下步骤:
1)机器人探测真实障碍物,并计算探测范围内真实障碍物的最大宽度,得到边界点A和B,坐标分别为qA和qB
2)对步骤1)得到的两点坐标进行虚拟障碍物虚拟障碍物相对机器人的坐标为其中:为该虚拟障碍物的中心点坐标;为该虚拟障碍物的半径大小;
3)机器人根据步骤2)得到的虚拟障碍物的坐标进行绕行,并不断地进行步骤1)中的探测。
前述的有限传感能力的机器人障碍物动态识别算法,其特征是,所述步骤1)中探测采用超声传感器或视觉传感器或激光传感器。
前述的有限传感能力的机器人障碍物动态识别算法,其特征是,所述机器人的探测范围为圆形。
本发明所达到的有益效果:本方法基于圆盘传感约束模型,模拟有限传感能力的机器人渐进障碍物探测的真实过程进行数学建模,不减小规划自由度,不降低导航控制器精度,而且能够保证在后续的导航控制器建模中避障的部分的连续性。
附图说明
图1(a)-(d)是机器人对障碍物的渐进探测过程;
图2是论证本方法合理性的示意图。
具体实施方式
下面结合附图对本发明作进一步描述。以下实施例仅用于更加清楚地说明本发明的技术方案,而不能以此来限制本发明的保护范围。
本发明的核心思路是:用一个虚拟的圆盘形状虚拟障碍物来描述真实障碍物被探测到的部分,即附图1中的虚线圆与点画线圆交叉的部分。
附图1和2中,真实的障碍物用点画线圆描述,虚线圆表示机器人的传感范围,其圆心是机器人中心位置,即位于圆心的机器人能探测到该圆圈范围以内的障碍物。
附图1(a)-(b)-(c)-(d)显示了机器人对障碍物的渐进探测过程。虚线圆与点画线圆交叉的部分即为机器人能探测到的障碍物部分。
由图1可见,随着机器人与被探测障碍物之间距离的减小,虚线圆与点画线圆交叉的部分由最初始的一个点,越来越大,直至完全覆盖被探测的障碍物。
为了保证避障效果,上述虚拟障碍物定义必须能够保证完全覆盖真实障碍物被探测到的部分,即图1中虚线圆与点画线圆交叉的部分。所述虚拟障碍物满足上述完全覆盖条件,下面对这一点进行论证:
如图2所示,设A′和B′两点为劣弧AA′B和AB′B上的任意两点,则在三角形中,有
其中,为真实障碍的中心位置,为虚拟障碍物的中心位置,d(·)代表欧几里得距离。
同样的方式,在三角形中,可得其中qi为机器人的中心位置。
综上,可得即从虚拟障碍物中心出发到障碍物被探测到的部分(图1中虚线圆与点画线圆交叉的部分)的边界上的任意一点的距离,均小于所述虚拟障碍物的半径也就是说,虚拟障碍物能够保证完全覆盖真实障碍物被探测到的部分。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。

Claims (2)

1.一种有限传感能力的机器人障碍物动态识别方法,其特征是,包括如下步骤:
1)机器人探测真实障碍物,并计算探测范围内真实障碍物的最大宽度,得到边界点A和B,坐标分别为qA和qB
2)对步骤1)得到的两点坐标进行虚拟障碍物虚拟障碍物相对机器人的坐标为其中:为该虚拟障碍物的中心点坐标;为该虚拟障碍物的半径大小;
3)机器人根据步骤2)得到的虚拟障碍物的坐标进行绕行,并不断地进行步骤1)中的探测;
所述机器人的探测范围为圆形。
2.根据权利要求1所述的有限传感能力的机器人障碍物动态识别算法,其特征是,所述步骤1)中探测采用超声传感器或视觉传感器或激光传感器。
CN201510874735.1A 2015-12-03 2015-12-03 一种有限传感能力的机器人障碍物动态识别算法 Active CN105538309B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510874735.1A CN105538309B (zh) 2015-12-03 2015-12-03 一种有限传感能力的机器人障碍物动态识别算法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510874735.1A CN105538309B (zh) 2015-12-03 2015-12-03 一种有限传感能力的机器人障碍物动态识别算法

Publications (2)

Publication Number Publication Date
CN105538309A CN105538309A (zh) 2016-05-04
CN105538309B true CN105538309B (zh) 2018-07-31

Family

ID=55818099

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510874735.1A Active CN105538309B (zh) 2015-12-03 2015-12-03 一种有限传感能力的机器人障碍物动态识别算法

Country Status (1)

Country Link
CN (1) CN105538309B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108481320B (zh) * 2017-01-09 2020-03-27 广东宝乐机器人股份有限公司 一种机器人的移动控制方法及机器人
CN109324619B (zh) * 2018-09-25 2021-10-22 苏州大学 液态金属电致驱动小车及其运动控制方法
CN109491394A (zh) * 2018-12-17 2019-03-19 中新智擎科技有限公司 一种虚拟避障方法、装置、存储介质及机器人

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5758298A (en) * 1994-03-16 1998-05-26 Deutsche Forschungsanstalt Fur Luft-Und Raumfahrt E.V. Autonomous navigation system for a mobile robot or manipulator
CN101231714A (zh) * 2007-12-05 2008-07-30 中原工学院 机器人三维路径规划方法
CN102313536A (zh) * 2011-07-21 2012-01-11 清华大学 基于机载双目视觉的障碍物感知方法
CN102831298A (zh) * 2012-07-30 2012-12-19 北京理工大学 一种用于目标发生器的目标实时路径规划方法
CN103926925A (zh) * 2014-04-22 2014-07-16 江苏久祥汽车电器集团有限公司 一种基于改进的vfh算法的定位与避障方法及机器人
CN104390640A (zh) * 2014-11-13 2015-03-04 沈阳航空航天大学 一种基于理想流体数值计算的无人机三维航路规划方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5758298A (en) * 1994-03-16 1998-05-26 Deutsche Forschungsanstalt Fur Luft-Und Raumfahrt E.V. Autonomous navigation system for a mobile robot or manipulator
CN101231714A (zh) * 2007-12-05 2008-07-30 中原工学院 机器人三维路径规划方法
CN102313536A (zh) * 2011-07-21 2012-01-11 清华大学 基于机载双目视觉的障碍物感知方法
CN102831298A (zh) * 2012-07-30 2012-12-19 北京理工大学 一种用于目标发生器的目标实时路径规划方法
CN103926925A (zh) * 2014-04-22 2014-07-16 江苏久祥汽车电器集团有限公司 一种基于改进的vfh算法的定位与避障方法及机器人
CN104390640A (zh) * 2014-11-13 2015-03-04 沈阳航空航天大学 一种基于理想流体数值计算的无人机三维航路规划方法

Also Published As

Publication number Publication date
CN105538309A (zh) 2016-05-04

Similar Documents

Publication Publication Date Title
US11727593B1 (en) Automated data capture
CN107688342B (zh) 机器人的避障控制***及方法
Zhang et al. Weld line detection and tracking via spatial-temporal cascaded hidden Markov models and cross structured light
Perez-Yus et al. Stairs detection with odometry-aided traversal from a wearable RGB-D camera
CN111693050B (zh) 基于建筑信息模型的室内中大型机器人导航方法
CN104077809B (zh) 基于结构性线条的视觉slam方法
CN110390306B (zh) 直角车位的检测方法、车辆和计算机可读存储介质
Tang et al. Plane-based detection of staircases using inverse depth
CN107526360A (zh) 一种未知环境下排爆机器人多阶自主导航探测***及方法
KR101789217B1 (ko) 기하학적 특징과 확률론적 기법을 이용한 실내 지도 생성 장치 및 방법
CN105538309B (zh) 一种有限传感能力的机器人障碍物动态识别算法
CN110942474B (zh) 机器人目标跟踪方法、设备及存储介质
Meng et al. Efficient and reliable LiDAR-based global localization of mobile robots using multiscale/resolution maps
US10902610B2 (en) Moving object controller, landmark, and moving object control method
CN113721633B (zh) 一种基于行人轨迹预测的移动机器人路径规划方法
CN115552348A (zh) 移动目标跟随方法、机器人和计算机可读存储介质
CN103744110B (zh) 超声与单目视觉传感器结合的障碍物识别装置
CN117392611A (zh) 工地安全监测方法、***、设备及存储介质
CN116189150B (zh) 基于融合输出的单目3d目标检测方法、装置、设备和介质
WO2023274270A1 (zh) 机器人术前导航方法、***、存储介质及计算机设备
CN115392407B (zh) 基于无监督学习的危险源预警方法、装置、设备及介质
Meng et al. A slope detection method based on 3D LiDAR suitable for quadruped robots
CN114489050A (zh) 沿直线行驶的避障路线控制方法、装置、设备及存储介质
CN112180947A (zh) 一种移动机器人初始行进方向选择方法及其设备
EP3229173B1 (en) Method and apparatus for determining a traversable path

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20220826

Address after: Room 313-314, Building 2, Yangcheng Lake International Science and Technology Pioneer Park, No. 116, Chengyang Road, Chengyang Street, Economic and Technological Development Zone, Xiangcheng District, Suzhou City, Jiangsu Province, 215000

Patentee after: Haibo (Suzhou) robot technology Co.,Ltd.

Address before: 215000, ten, 1 Zi street, Jiangsu, Suzhou

Patentee before: SOOCHOW University

TR01 Transfer of patent right