CN114415662A - 一种智能机器人避障方法及装置 - Google Patents
一种智能机器人避障方法及装置 Download PDFInfo
- Publication number
- CN114415662A CN114415662A CN202111533754.XA CN202111533754A CN114415662A CN 114415662 A CN114415662 A CN 114415662A CN 202111533754 A CN202111533754 A CN 202111533754A CN 114415662 A CN114415662 A CN 114415662A
- Authority
- CN
- China
- Prior art keywords
- robot
- distance
- preset
- obstacle
- obstacles
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000001514 detection method Methods 0.000 claims abstract description 13
- 230000004888 barrier function Effects 0.000 claims description 56
- 238000005259 measurement Methods 0.000 claims description 14
- 238000011065 in-situ storage Methods 0.000 claims description 12
- 238000010586 diagram Methods 0.000 description 7
- 238000004891 communication Methods 0.000 description 6
- 239000011521 glass Substances 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000010521 absorption reaction Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000000644 propagated effect Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 239000012780 transparent material Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Optics & Photonics (AREA)
- Acoustics & Sound (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本申请公开了一种智能机器人避障方法及装置,包括:采用超声波检测机器人多个方向的障碍物,并计算机器人与障碍物之间的第一距离;若第一距离小于预置第一安全距离,则执行超声波避障策略;若第一距离大于等于预置第一安全距离,则采用激光雷达检测机器人多个方向的障碍物,并计算机器人与障碍物之间的第二距离;若存在第二距离大于等于预置第一安全距离且小于预置第二安全距离,则执行激光雷达避障策略;若第二距离大于等于预置第二安全距离,则机器人按照原规划路线前行。本申请选择超声检测和激光雷达检测相搭配方式能够适应于多种不同的环境下的机器人避障。
Description
技术领域
本申请涉及机器人避障技术领域,尤其涉及一种智能机器人避障方法及装置。
背景技术
随着机器人在工厂、仓库、酒店、商场、餐厅等环境中的使用,人们对机器人的移动能力越为重视,以至于避障成为一个极为关键且必要的功能。人们希望机器人能根据采集的障碍物的状态信息,在行走过程中通过传感器感知到妨碍其通行的静态或动态物体,然后按照一定的方法进行有效避障,最终到达目标点。
实现避障的必要条件是环境感知,在未知或者是部分未知的环境下避障需要通过传感器获取周围环境信息,包括障碍物的尺寸、形状和位置等信息,因此传感器测距技术在移动机器人避障中起着十分重要的作用。
发明内容
本申请提供了一种智能机器人避障方法及装置,使得能够适应于多种不同的环境下的机器人避障。
有鉴于此,本申请第一方面提供了一种智能机器人避障方法,所述方法包括:
采用超声波检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第一距离;
若所述第一距离小于预置第一安全距离,则执行超声波避障策略;
若所述第一距离大于等于所述预置第一安全距离,则采用激光雷达检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第二距离;
若存在所述第二距离大于等于所述预置第一安全距离且小于预置第二安全距离,则执行激光雷达避障策略;
若所述第二距离大于等于所述预置第二安全距离,则机器人按照原规划路线前行。
可选的,所述采用超声波检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第一距离,包括:
采用机器人正前方、左侧和右侧的超声波传感器分别测量机器人的正前方、左侧和右侧是否存在障碍物,并计算机器人与障碍物之间的第一距离,所述第一距离包括机器人与正前方障碍物、左侧障碍物以及右侧障碍物之间的距离。
可选的,所述若所述第一距离小于预置第一安全距离,则执行超声波避障策略,具体为:
若机器人与正前方障碍物、左侧障碍物以及右侧障碍物的距离均小于所述预置第一安全距离,则机器人原地调转180度后直行;
若机器人与左侧障碍物以及右侧障碍物的距离小于所述预置第一安全距离,与正前方障碍物的距离大于等于所述预置第一安全距离,则机器人继续往前直行;
若机器人与左侧障碍物的距离小于所述预置第一安全距离,与正前方障碍物和右侧障碍物的距离大于或等于所述预置第一安全距离,则机器人往右旋转预置弧度后往前直行;
若机器人与左侧障碍物和正前方障碍物的距离小于所述预置第一安全距离,与右侧障碍物的距离大于或等于所述预置第一安全距离,则机器人往右快旋转预置弧度后直行;
若机器人与右侧障碍物的距离小于所述预置第一安全距离,与正前方障碍物和左侧障碍物的距离大于或等于所述预置第一安全距离,则机器人往左旋转预置弧度后直行;
若机器人与右侧障碍物和正前方障碍物的距离小于所述预置第一安全距离,与左侧障碍物的距离大于或等于所述预置第一安全距离,则机器人往左旋转预置弧度后直行;
若机器人与正前方障碍物的距离小于所述预置第一安全距离,与右侧障碍物和左侧障碍物的距离大于或等于所述预置第一安全距离;当与左侧障碍物的距离大于与右侧障碍物的距离,则往左旋转预置弧度后直行;当与左侧障碍物的距离小于与右侧障碍物的距离,往右旋转预置弧度后直行。
可选的,所述若所述第一距离大于等于所述预置第一安全距离,则采用激光雷达检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第二距离,包括:
当采用超声波检测机器人与多个方向障碍物烦人第一距离大于等于所述预置第一安全距离;
则采用激光雷达检测机器人正前方-90°~90°是否存在障碍物,并计算机器人与所述障碍物之间的所述第二距离,-90°~-45°为1区,-45°~0°为2区,0°~45°为3区,45°~90°为4区。
可选的,所述若存在所述第二距离大于等于所述预置第一安全距离且小于预置第二安全距离,则执行激光雷达避障策略,包括:
当测得1区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离时,则机器人原地左旋转预置角度;
当测得4区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,原地右旋转预置角度;
当测得1区和2区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,3区和4区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人原地左快旋转预置角度;
当测得3和4区域内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和2区内存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人原地右快旋转预置角度;
当2区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人左旋转预置角度;
当3区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,其余三个区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人右旋转预置角度;
当2区和3区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和4区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离大于3区内的障碍物与机器人的实际最小距离,则机器人右旋转预置角度;
当2区和3区内的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和4区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离小于3区内的障碍物与机器人的实际最小距离,则机器人左旋转预置角度;
当只有1区的障碍物与机器人的实际最小距离值大于所述预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于所述预置第二安全距离,机器人右旋转预置角度;
当只有4区内的障碍物与机器人的实际最小距离值大于所述预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于所述预置第二安全距离,则机器人左旋转预置角度;
当四个区内的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值大于4区内的障碍物与机器人的实际最小距离值,机器人右旋转预置角度;
当四个区内的障碍物与机器人的的实际最小距离值小于所述预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值小于4区内的障碍物与机器人的实际最小距离值,则机器人左旋转预置角度。
本申请第二方面提供一种智能机器人避障装置,所述装置包括:
超声测距单元,用于采用超声波检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第一距离;
第一执行单元,用于若所述第一距离小于预置第一安全距离,则执行超声波避障策略;
激光雷达测距单元,用于若所述第一距离大于等于所述预置第一安全距离,则采用激光雷达检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第二距离;
第二执行单元,用于若存在所述第二距离大于等于所述预置第一安全距离且小于预置第二安全距离,则执行激光雷达避障策略;
第三执行单元,用于若所述第二距离大于等于所述预置第二安全距离,则机器人按照原规划路线前行。
可选的,所述超声测距单元具体用于采用机器人正前方、左侧和右侧的超声波传感器分别测量机器人的正前方、左侧和右侧是否存在障碍物,并计算机器人与障碍物之间的第一距离,所述第一距离包括机器人与正前方障碍物、左侧障碍物以及右侧障碍物之间的距离。
可选的,所述第一执行单元包括:
第一运行单元,用于当机器人与正前方障碍物、左侧障碍物以及右侧障碍物的距离均小于所述预置第一安全距离时,则机器人原地调转180度后直行;
第二运行单元,用于当机器人与左侧障碍物以及右侧障碍物的距离小于所述预置第一安全距离时,与正前方障碍物的距离大于等于所述预置第一安全距离,则机器人继续往前直行;
第三运行单元,用于当机器人与左侧障碍物的距离小于所述预置第一安全距离,与正前方障碍物和右侧障碍物的距离大于或等于所述预置第一安全距离时,则机器人往右旋转预置弧度后往前直行;
第四运行单元,用于当机器人与左侧障碍物和正前方障碍物的距离小于所述预置第一安全距离,与右侧障碍物的距离大于或等于所述预置第一安全距离时,则机器人往右快旋转预置弧度后直行;
第五运行单元,用于当机器人与右侧障碍物的距离小于所述预置第一安全距离,与正前方障碍物和左侧障碍物的距离大于或等于所述预置第一安全距离时,则机器人往左旋转预置弧度后直行;
第六运行单元,用于当机器人与右侧障碍物和正前方障碍物的距离小于所述预置第一安全距离,与左侧障碍物的距离大于或等于所述预置第一安全距离时,则机器人往左旋转预置弧度后直行;
第三运行单元,用于当机器人与正前方障碍物的距离小于所述预置第一安全距离,与右侧障碍物和左侧障碍物的距离大于或等于所述预置第一安全距离;当与左侧障碍物的距离大于与右侧障碍物的距离时,则往左旋转预置弧度后直行;当与左侧障碍物的距离小于与右侧障碍物的距离时,往右旋转预置弧度后直行。
可选的,所述激光雷达测距单元具体用于当采用超声波检测机器人与多个方向障碍物烦人第一距离大于等于所述预置第一安全距离时;则采用激光雷达检测机器人正前方-90°~90°是否存在障碍物,并计算机器人与所述障碍物之间的所述第二距离,-90°~-45°为1区,-45°~0°为2区,0°~45°为3区,45°~90°为4区。
可选的,所述第二执行单元,包括:
第一旋转单元,用于当测得1区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离时,则机器人原地左旋转预置角度;
第二旋转单元,用于当测得4区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,原地右旋转预置角度;
第三旋转单元,用于当测得1区和2区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,3区和4区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人原地左快旋转预置角度;
第四旋转单元,用于当测得3和4区域内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和2区内存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人原地右快旋转预置角度;
第五旋转单元,用于当2区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人左旋转预置角度;
第六旋转单元,用于当3区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,其余三个区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人右旋转预置角度;
第七旋转单元,用于当2区和3区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和4区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离大于3区内的障碍物与机器人的实际最小距离,则机器人右旋转预置角度;
第八旋转单元,用于当2区和3区内的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和4区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离小于3区内的障碍物与机器人的实际最小距离,则机器人左旋转预置角度;
第九旋转单元,用于当只有1区的障碍物与机器人的实际最小距离值大于所述预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于所述预置第二安全距离,机器人右旋转预置角度;
第十旋转单元,用于当只有4区内的障碍物与机器人的实际最小距离值大于所述预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于所述预置第二安全距离,则机器人左旋转预置角度;
第十一旋转单元,用于当四个区内的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值大于4区内的障碍物与机器人的实际最小距离值,机器人右旋转预置角度;
第十二旋转单元,用于当四个区内的障碍物与机器人的的实际最小距离值小于所述预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值小于4区内的障碍物与机器人的实际最小距离值,则机器人左旋转预置角度。
从以上技术方案可以看出,本申请具有以下优点:
本申请中,提供了一种智能机器人避障方法,包括:采用超声波检测机器人多个方向的障碍物,并计算机器人与障碍物之间的第一距离;若第一距离小于预置第一安全距离,则执行超声波避障策略;若第一距离大于等于预置第一安全距离,则采用激光雷达检测机器人多个方向的障碍物,并计算机器人与障碍物之间的第二距离;若存在第二距离大于等于预置第一安全距离且小于预置第二安全距离,则执行激光雷达避障策略;若第二距离大于等于预置第二安全距离,则机器人按照原规划路线前行。
本申请首先通过超声波检测机器人近距离范围内的障碍物位置,并计算障碍物到机器人的距离,当存在障碍物到机器人的距离小于安全距离时,则及时控制机器人偏转,使得机器人能够避开存在玻璃、镜面等物体的场景;而当近距离范围内没有障碍物时,可以采用激光雷达进行测量,实现对较大范围内的障碍物的测量,其测量精度更高且能使机器人进行快速的反馈,完成高精度的机器人避障。
附图说明
图1为本申请一种智能机器人避障方法的一个实施例的方法流程图;
图2为本申请一种智能机器人避障装置的一个实施例的装置结构图;
图3为本申请实施例中超声测距的原理图;
图4为本申请实施例中激光雷达测距的电路原理图;
图5为本申请实施例中激光传感器测距的三角测量原理示意图;
图6为本申请实施例中采用激光雷达测距时对应的激光雷达避障区域示意图。
具体实施方式
本申请首先通过超声波检测机器人近距离范围内的障碍物位置,并计算障碍物到机器人的距离,当存在障碍物到机器人的距离小于安全距离时,则及时控制机器人偏转,使得机器人能够避开存在玻璃、镜面等物体的场景;而当近距离范围内没有障碍物时,可以采用激光雷达进行测量,实现对较大范围内的障碍物的测量,其测量精度更高且能使机器人进行快速的反馈,完成高精度的机器人避障。
超声波测距的原理如下图3所示,超声波的发射端发射一束超声波,在发射的同时,计时开始,发射出去的超声波在介质中传播,声波具有反射特性,当遇到障碍物时就会反射回来,当超声波的接收端接收到反射回来的超声波时,计时停止。介质为空气时,声速为340m/s,根据记录的时间t,利用公式计算出发射位置与障碍物之间的距离L。
L=340t/2
超声波传感器一般作用距离较短,普通的有效探测距离都在几米,但是会有一个几十毫米左右的最小探测盲区。另外,超声波的测量周期较长,比如3米左右的物体,声波传输这么远的距离需要约20ms的时间。再者,不同材料对声波的反射或者吸引是不相同的,还有多个超声传感器之间有可能会互相干扰,因此其抗干扰能力较差。但是超声波传感器可以识别玻璃、镜面等激光雷达难以识别的物体。
激光雷达的电路原理图如图4所示,包括发射器和接收器,发射器用激光照射目标,接收器接收反向回的光波。机械式的激光雷达还包括一个带有镜子的机械机构,镜子的旋转使得光束可以覆盖一个平面,可以测量到一个平面上的距离信息。
激光避障与红外线类似,也是发射激光然后接收。激光传感器的测量方式有很多种,有类似红外的三角测量原理示意图5,也有类似于超声波的时间差+速度。其测量公式为:
d=f×s/(L×sinβ)
无论选择那一种方式,激光避障的精度、反馈速度、抗干扰能力和有效范围都要显优于红外和超声波。
激光雷达的测量距离可以达到几十米甚至上百米,角度分辨率高,通常可以达到零点几度,测距的精度也高。但是黑体或者远距离的物体距离测量不会像光亮的、近距离的物体那么好的估计,并且对于透明材料,比如玻璃,激光雷达就无能为力了。还由于结构的复杂、器件成本高,激光雷达的成本也很高。
为了使本技术领域的人员更好地理解本申请方案,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
图1为本申请一种智能机器人避障方法的一个实施例的方法流程图,如图1所示,图1中包括:
101、采用超声波检测机器人多个方向的障碍物,并计算机器人与障碍物之间的第一距离;
需要说明的是,可以采用超声波测距传感器测量机器人周围多个方向的障碍物,并计算机器人到障碍物之间的距离。
在一种具体的实施方式中,可以采用机器人正前方、左侧和右侧的超声波传感器分别测量机器人的正前方、左侧和右侧是否存在障碍物,并计算机器人与障碍物之间的第一距离,第一距离包括机器人与正前方障碍物、左侧障碍物以及右侧障碍物之间的距离。
假设超声波测距传感器与运动控制器相连接,通过串口通信的方式与运动控制器进行数据传输的。运动控制器读取到超声波测距传感器的检测数据,并对检测数据进行数据转换,再通过串口通讯协议将数据发送到主控器上,由主控制器根据获取的数据进行计算,得到障碍物与机器人的距离。
102、若第一距离小于预置第一安全距离,则执行超声波避障策略;
需要说明的是,智能机器人在沿直线运行过程中,超声波检测到障碍物时,底盘控制节点(mobile_base)将获取到三个方向的超声波测距值,把三个超声波的测距值与安全距离值进行比较分析,推算出智能机器人绕开障碍物的方向(左转、右转、掉头、直走)和速度。当机器人与障碍物之间的距离小于预置的安全距离时,机器人需要进行及时的避障,具体的避障策略如下:
在一种具体的实施方式中,若机器人与正前方障碍物、左侧障碍物以及右侧障碍物的距离均小于预置第一安全距离,则机器人原地调转180度后直行;
若机器人与左侧障碍物以及右侧障碍物的距离小于预置第一安全距离,与正前方障碍物的距离大于等于预置第一安全距离,则机器人继续往前直行;
若机器人与左侧障碍物的距离小于预置第一安全距离,与正前方障碍物和右侧障碍物的距离大于或等于预置第一安全距离,则机器人往右旋转预置弧度后往前直行;
若机器人与左侧障碍物和正前方障碍物的距离小于预置第一安全距离,与右侧障碍物的距离大于或等于预置第一安全距离,则机器人往右快旋转预置弧度后直行;
若机器人与右侧障碍物的距离小于预置第一安全距离,与正前方障碍物和左侧障碍物的距离大于或等于预置第一安全距离,则机器人往左旋转预置弧度后直行;
若机器人与右侧障碍物和正前方障碍物的距离小于预置第一安全距离,与左侧障碍物的距离大于或等于预置第一安全距离,则机器人往左旋转预置弧度后直行;
若机器人与正前方障碍物的距离小于预置第一安全距离,与右侧障碍物和左侧障碍物的距离大于或等于预置第一安全距离;当与左侧障碍物的距离大于与右侧障碍物的距离,则往左旋转预置弧度后直行;当与左侧障碍物的距离小于与右侧障碍物的距离,往右旋转预置弧度后直行。
103、若第一距离大于等于预置第一安全距离,则采用激光雷达检测机器人多个方向的障碍物,并计算机器人与障碍物之间的第二距离;
需要说明的是,当测得障碍物与机器人的距离大于等于超声检测的安全距离时,即近距离的范围内不存在障碍物(重点包括玻璃、镜面等)时,可以采用激光雷达检测机器人多个方向的障碍物,并计算机器人与障碍物之间的第二距离;
在一种具体的实施方式中,当采用超声波检测机器人与多个方向障碍物烦人第一距离大于等于预置第一安全距离;则采用激光雷达检测机器人正前方-90°~90°是否存在障碍物,并计算机器人与障碍物之间的第二距离,-90°~-45°为1区,-45°~0°为2区,0°~45°为3区,45°~90°为4区。
可以假设激光雷达传感器与运动控制器相连接,通过串口通信的方式与运动控制器进行数据传输的,运动控制器读取到超声波测距传感器的检测数据,并对检测数据进行数据转换,再通过串口通讯协议将数据发送到主控器上,由主控器对接收到的数据进行计算,计算机器人到障碍物的实际最小距离。
104、若存在第二距离大于等于预置第一安全距离且小于预置第二安全距离,则执行激光雷达避障策略;
需要说明的是,若通过激光雷达测量机器人到障碍物之间的距离大于超声波测量对应的安全距离,且小于激光雷达测量时对应的理论安全距离时,则可以执行激光雷达避障策略。
由于激光雷达的测距角度一般为0~360°,需要根据实际使用设置开始扫描的角度和结束扫描的角度。如下图6,以图的上半部分为例,假设使用激光雷达正前方的180°测距角度,设置为-90°~90°。L1为智能机器人横向安全距离,大于底盘半径r,L2为智能机器人纵向避障距离,纵向距离小于该值划为避障区域。根据安全避障的横向/纵向安全距离,划分为1、2、3、4四个区域的激光雷达角度检测值,区域内为需要避障区域。
根据四个区域中,激光雷达检测到的实际最小距离值和预置第二安全距离值(L/sinθ或L/cosθ)的关系来确定机器人的运动控制策略,其具体的避障策略为:
当测得1区内存在的障碍物与机器人的实际最小距离值小于预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于预置第二安全距离时,则机器人原地左旋转预置角度;
当测得4区内存在的障碍物与机器人的实际最小距离值小于预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于预置第二安全距离,原地右旋转预置角度;
当测得1区和2区内存在的障碍物与机器人的实际最小距离值小于预置第二安全距离值,3区和4区存在的障碍物与机器人的实际最小距离都大于预置第二安全距离,则机器人原地左快旋转预置角度;
当测得3和4区域内存在的障碍物与机器人的实际最小距离值小于预置第二安全距离值,1区和2区内存在的障碍物与机器人的实际最小距离都大于预置第二安全距离,则机器人原地右快旋转预置角度;
当2区存在的障碍物与机器人的实际最小距离值小于预置第二安全距离值,其余三个区的障碍物与机器人的实际最小距离都大于预置第二安全距离,则机器人左旋转预置角度;
当3区存在的障碍物与机器人的实际最小距离值小于预置第二安全距离值,其余三个区存在的障碍物与机器人的实际最小距离都大于预置第二安全距离,则机器人右旋转预置角度;
当2区和3区存在的障碍物与机器人的实际最小距离值小于预置第二安全距离值,1区和4区存在的障碍物与机器人的实际最小距离都大于预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离大于3区内的障碍物与机器人的实际最小距离,则机器人右旋转预置角度;
当2区和3区内的障碍物与机器人的实际最小距离值小于预置第二安全距离值,1区和4区的障碍物与机器人的实际最小距离都大于预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离小于3区内的障碍物与机器人的实际最小距离,则机器人左旋转预置角度;
当只有1区的障碍物与机器人的实际最小距离值大于预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于预置第二安全距离,机器人右旋转预置角度;
当只有4区内的障碍物与机器人的实际最小距离值大于预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于预置第二安全距离,则机器人左旋转预置角度;
当四个区内的障碍物与机器人的实际最小距离值小于预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值大于4区内的障碍物与机器人的实际最小距离值,机器人右旋转预置角度;
当四个区内的障碍物与机器人的的实际最小距离值小于预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值小于4区内的障碍物与机器人的实际最小距离值,则机器人左旋转预置角度。
105、若第二距离大于等于预置第二安全距离,则机器人按照原规划路线前行。
需要说明的是,当机器人周围一定距离的范围内都不存在障碍物时,则机器人可以可以按照正常的规划路线执行原既定任务。
本申请首先通过超声波检测机器人近距离范围内的障碍物位置,并计算障碍物到机器人的距离,当存在障碍物到机器人的距离小于安全距离时,则及时控制机器人偏转,使得机器人能够避开存在玻璃、镜面等物体的场景;而当近距离范围内没有障碍物时,可以采用激光雷达进行测量,实现对较大范围内的障碍物的测量,其测量精度更高且能使机器人进行快速的反馈,完成高精度的机器人避障。
本申请还提供了一种智能机器人避障装置的一个实施例,如图2所示,图2中包括:
超声测距单元201,用于采用超声波检测机器人多个方向的障碍物,并计算机器人与障碍物之间的第一距离;
第一执行单元202,用于若第一距离小于预置第一安全距离,则执行超声波避障策略;
激光雷达测距单元203,用于若第一距离大于等于预置第一安全距离,则采用激光雷达检测机器人多个方向的障碍物,并计算机器人与障碍物之间的第二距离;
第二执行单元204,用于若存在第二距离大于等于预置第一安全距离且小于预置第二安全距离,则执行激光雷达避障策略;
第三执行单元205,用于若第二距离大于等于预置第二安全距离,则机器人按照原规划路线前行。
在一种具体的实施方式中,超声测距单元具体用于采用机器人正前方、左侧和右侧的超声波传感器分别测量机器人的正前方、左侧和右侧是否存在障碍物,并计算机器人与障碍物之间的第一距离,第一距离包括机器人与正前方障碍物、左侧障碍物以及右侧障碍物之间的距离。
在一种具体的实施方式中,第一执行单元202包括:
第一运行单元,用于当机器人与正前方障碍物、左侧障碍物以及右侧障碍物的距离均小于预置第一安全距离时,则机器人原地调转180度后直行;
第二运行单元,用于当机器人与左侧障碍物以及右侧障碍物的距离小于预置第一安全距离时,与正前方障碍物的距离大于等于预置第一安全距离,则机器人继续往前直行;
第三运行单元,用于当机器人与左侧障碍物的距离小于预置第一安全距离,与正前方障碍物和右侧障碍物的距离大于或等于预置第一安全距离时,则机器人往右旋转预置弧度后往前直行;
第四运行单元,用于当机器人与左侧障碍物和正前方障碍物的距离小于预置第一安全距离,与右侧障碍物的距离大于或等于预置第一安全距离时,则机器人往右快旋转预置弧度后直行;
第五运行单元,用于当机器人与右侧障碍物的距离小于预置第一安全距离,与正前方障碍物和左侧障碍物的距离大于或等于预置第一安全距离时,则机器人往左旋转预置弧度后直行;
第六运行单元,用于当机器人与右侧障碍物和正前方障碍物的距离小于预置第一安全距离,与左侧障碍物的距离大于或等于预置第一安全距离时,则机器人往左旋转预置弧度后直行;
第三运行单元,用于当机器人与正前方障碍物的距离小于预置第一安全距离,与右侧障碍物和左侧障碍物的距离大于或等于预置第一安全距离;当与左侧障碍物的距离大于与右侧障碍物的距离时,则往左旋转预置弧度后直行;当与左侧障碍物的距离小于与右侧障碍物的距离时,往右旋转预置弧度后直行。
在一种具体的实施方式中,激光雷达测距单元203具体用于当采用超声波检测机器人与多个方向障碍物烦人第一距离大于等于预置第一安全距离时;则采用激光雷达检测机器人正前方-90°~90°是否存在障碍物,并计算机器人与障碍物之间的第二距离,-90°~-45°为1区,-45°~0°为2区,0°~45°为3区,45°~90°为4区。
在一种具体的实施方式中,第二执行单元204包括:
第一旋转单元,用于当测得1区内存在的障碍物与机器人的实际最小距离值小于预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于预置第二安全距离时,则机器人原地左旋转预置角度;
第二旋转单元,用于当测得4区内存在的障碍物与机器人的实际最小距离值小于预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于预置第二安全距离,原地右旋转预置角度;
第三旋转单元,用于当测得1区和2区内存在的障碍物与机器人的实际最小距离值小于预置第二安全距离值,3区和4区存在的障碍物与机器人的实际最小距离都大于预置第二安全距离,则机器人原地左快旋转预置角度;
第四旋转单元,用于当测得3和4区域内存在的障碍物与机器人的实际最小距离值小于预置第二安全距离值,1区和2区内存在的障碍物与机器人的实际最小距离都大于预置第二安全距离,则机器人原地右快旋转预置角度;
第五旋转单元,用于当2区存在的障碍物与机器人的实际最小距离值小于预置第二安全距离值,其余三个区的障碍物与机器人的实际最小距离都大于预置第二安全距离,则机器人左旋转预置角度;
第六旋转单元,用于当3区存在的障碍物与机器人的实际最小距离值小于预置第二安全距离值,其余三个区存在的障碍物与机器人的实际最小距离都大于预置第二安全距离,则机器人右旋转预置角度;
第七旋转单元,用于当2区和3区存在的障碍物与机器人的实际最小距离值小于预置第二安全距离值,1区和4区存在的障碍物与机器人的实际最小距离都大于预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离大于3区内的障碍物与机器人的实际最小距离,则机器人右旋转预置角度;
第八旋转单元,用于当2区和3区内的障碍物与机器人的实际最小距离值小于预置第二安全距离值,1区和4区的障碍物与机器人的实际最小距离都大于预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离小于3区内的障碍物与机器人的实际最小距离,则机器人左旋转预置角度;
第九旋转单元,用于当只有1区的障碍物与机器人的实际最小距离值大于预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于预置第二安全距离,机器人右旋转预置角度;
第十旋转单元,用于当只有4区内的障碍物与机器人的实际最小距离值大于预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于预置第二安全距离,则机器人左旋转预置角度;
第十一旋转单元,用于当四个区内的障碍物与机器人的实际最小距离值小于预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值大于4区内的障碍物与机器人的实际最小距离值,机器人右旋转预置角度;
第十二旋转单元,用于当四个区内的障碍物与机器人的的实际最小距离值小于预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值小于4区内的障碍物与机器人的实际最小距离值,则机器人左旋转预置角度。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统,装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
本申请的说明书及上述附图中的术语“第一”、“第二”、“第三”、“第四”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本申请的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
应当理解,在本申请中,“至少一个(项)”是指一个或者多个,“多个”是指两个或两个以上。“和/或”,用于描述关联对象的关联关系,表示可以存在三种关系,例如,“A和/或B”可以表示:只存在A,只存在B以及同时存在A和B三种情况,其中A,B可以是单数或者复数。字符“/”一般表示前后关联对象是一种“或”的关系。“以下至少一项(个)”或其类似表达,是指这些项中的任意组合,包括单项(个)或复数项(个)的任意组合。例如,a,b或c中的至少一项(个),可以表示:a,b,c,“a和b”,“a和c”,“b和c”,或“a和b和c”,其中a,b,c可以是单个,也可以是多个。
在本申请所提供的几个实施例中,应该理解到,所揭露的装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本申请各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
以上所述,以上实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的精神和范围。
Claims (10)
1.一种智能机器人避障方法,其特征在于,包括:
采用超声波检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第一距离;
若所述第一距离小于预置第一安全距离,则执行超声波避障策略;
若所述第一距离大于等于所述预置第一安全距离,则采用激光雷达检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第二距离;
若存在所述第二距离大于等于所述预置第一安全距离且小于预置第二安全距离,则执行激光雷达避障策略;
若所述第二距离大于等于所述预置第二安全距离,则机器人按照原规划路线前行。
2.根据权利要求1所述的智能机器人避障方法,其特征在于,所述采用超声波检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第一距离,包括:
采用机器人正前方、左侧和右侧的超声波传感器分别测量机器人的正前方、左侧和右侧是否存在障碍物,并计算机器人与障碍物之间的第一距离,所述第一距离包括机器人与正前方障碍物、左侧障碍物以及右侧障碍物之间的距离。
3.根据权利要求2所述的智能机器人避障方法,其特征在于,所述若所述第一距离小于预置第一安全距离,则执行超声波避障策略,具体为:
若机器人与正前方障碍物、左侧障碍物以及右侧障碍物的距离均小于所述预置第一安全距离,则机器人原地调转180度后直行;
若机器人与左侧障碍物以及右侧障碍物的距离小于所述预置第一安全距离,与正前方障碍物的距离大于等于所述预置第一安全距离,则机器人继续往前直行;
若机器人与左侧障碍物的距离小于所述预置第一安全距离,与正前方障碍物和右侧障碍物的距离大于或等于所述预置第一安全距离,则机器人往右旋转预置弧度后往前直行;
若机器人与左侧障碍物和正前方障碍物的距离小于所述预置第一安全距离,与右侧障碍物的距离大于或等于所述预置第一安全距离,则机器人往右快旋转预置弧度后直行;
若机器人与右侧障碍物的距离小于所述预置第一安全距离,与正前方障碍物和左侧障碍物的距离大于或等于所述预置第一安全距离,则机器人往左旋转预置弧度后直行;
若机器人与右侧障碍物和正前方障碍物的距离小于所述预置第一安全距离,与左侧障碍物的距离大于或等于所述预置第一安全距离,则机器人往左旋转预置弧度后直行;
若机器人与正前方障碍物的距离小于所述预置第一安全距离,与右侧障碍物和左侧障碍物的距离大于或等于所述预置第一安全距离;当与左侧障碍物的距离大于与右侧障碍物的距离,则往左旋转预置弧度后直行;当与左侧障碍物的距离小于与右侧障碍物的距离,往右旋转预置弧度后直行。
4.根据权利要求1所述的智能机器人避障方法,其特征在于,所述若所述第一距离大于等于所述预置第一安全距离,则采用激光雷达检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第二距离,包括:
当采用超声波检测机器人与多个方向障碍物烦人第一距离大于等于所述预置第一安全距离;
则采用激光雷达检测机器人正前方-90°~90°是否存在障碍物,并计算机器人与所述障碍物之间的所述第二距离,-90°~-45°为1区,-45°~0°为2区,0°~45°为3区,45°~90°为4区。
5.根据权利要求4所述的智能机器人避障方法,其特征在于,所述若存在所述第二距离大于等于所述预置第一安全距离且小于预置第二安全距离,则执行激光雷达避障策略,包括:
当测得1区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离时,则机器人原地左旋转预置角度;
当测得4区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,原地右旋转预置角度;
当测得1区和2区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,3区和4区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人原地左快旋转预置角度;
当测得3和4区域内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和2区内存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人原地右快旋转预置角度;
当2区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人左旋转预置角度;
当3区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,其余三个区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人右旋转预置角度;
当2区和3区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和4区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离大于3区内的障碍物与机器人的实际最小距离,则机器人右旋转预置角度;
当2区和3区内的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和4区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离小于3区内的障碍物与机器人的实际最小距离,则机器人左旋转预置角度;
当只有1区的障碍物与机器人的实际最小距离值大于所述预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于所述预置第二安全距离,机器人右旋转预置角度;
当只有4区内的障碍物与机器人的实际最小距离值大于所述预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于所述预置第二安全距离,则机器人左旋转预置角度;
当四个区内的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值大于4区内的障碍物与机器人的实际最小距离值,机器人右旋转预置角度;
当四个区内的障碍物与机器人的的实际最小距离值小于所述预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值小于4区内的障碍物与机器人的实际最小距离值,则机器人左旋转预置角度。
6.一种智能机器人避障装置,其特征在于,包括:
超声测距单元,用于采用超声波检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第一距离;
第一执行单元,用于若所述第一距离小于预置第一安全距离,则执行超声波避障策略;
激光雷达测距单元,用于若所述第一距离大于等于所述预置第一安全距离,则采用激光雷达检测机器人多个方向的障碍物,并计算机器人与所述障碍物之间的第二距离;
第二执行单元,用于若存在所述第二距离大于等于所述预置第一安全距离且小于预置第二安全距离,则执行激光雷达避障策略;
第三执行单元,用于若所述第二距离大于等于所述预置第二安全距离,则机器人按照原规划路线前行。
7.根据权利要求6所述的智能机器人避障装置,其特征在于,所述超声测距单元具体用于采用机器人正前方、左侧和右侧的超声波传感器分别测量机器人的正前方、左侧和右侧是否存在障碍物,并计算机器人与障碍物之间的第一距离,所述第一距离包括机器人与正前方障碍物、左侧障碍物以及右侧障碍物之间的距离。
8.根据权利要求7所述的智能机器人避障装置,其特征在于,所述第一执行单元包括:
第一运行单元,用于当机器人与正前方障碍物、左侧障碍物以及右侧障碍物的距离均小于所述预置第一安全距离时,则机器人原地调转180度后直行;
第二运行单元,用于当机器人与左侧障碍物以及右侧障碍物的距离小于所述预置第一安全距离时,与正前方障碍物的距离大于等于所述预置第一安全距离,则机器人继续往前直行;
第三运行单元,用于当机器人与左侧障碍物的距离小于所述预置第一安全距离,与正前方障碍物和右侧障碍物的距离大于或等于所述预置第一安全距离时,则机器人往右旋转预置弧度后往前直行;
第四运行单元,用于当机器人与左侧障碍物和正前方障碍物的距离小于所述预置第一安全距离,与右侧障碍物的距离大于或等于所述预置第一安全距离时,则机器人往右快旋转预置弧度后直行;
第五运行单元,用于当机器人与右侧障碍物的距离小于所述预置第一安全距离,与正前方障碍物和左侧障碍物的距离大于或等于所述预置第一安全距离时,则机器人往左旋转预置弧度后直行;
第六运行单元,用于当机器人与右侧障碍物和正前方障碍物的距离小于所述预置第一安全距离,与左侧障碍物的距离大于或等于所述预置第一安全距离时,则机器人往左旋转预置弧度后直行;
第三运行单元,用于当机器人与正前方障碍物的距离小于所述预置第一安全距离,与右侧障碍物和左侧障碍物的距离大于或等于所述预置第一安全距离;当与左侧障碍物的距离大于与右侧障碍物的距离时,则往左旋转预置弧度后直行;当与左侧障碍物的距离小于与右侧障碍物的距离时,往右旋转预置弧度后直行。
9.根据权利要求6所述的智能机器人避障装置,其特征在于,所述激光雷达测距单元具体用于当采用超声波检测机器人与多个方向障碍物烦人第一距离大于等于所述预置第一安全距离时;则采用激光雷达检测机器人正前方-90°~90°是否存在障碍物,并计算机器人与所述障碍物之间的所述第二距离,-90°~-45°为1区,-45°~0°为2区,0°~45°为3区,45°~90°为4区。
10.根据权利要求9所述的智能机器人避障装置,其特征在于,所述第二执行单元,包括:
第一旋转单元,用于当测得1区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离时,则机器人原地左旋转预置角度;
第二旋转单元,用于当测得4区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,原地右旋转预置角度;
第三旋转单元,用于当测得1区和2区内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,3区和4区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人原地左快旋转预置角度;
第四旋转单元,用于当测得3和4区域内存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和2区内存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人原地右快旋转预置角度;
第五旋转单元,用于当2区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,其余三个区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人左旋转预置角度;
第六旋转单元,用于当3区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,其余三个区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,则机器人右旋转预置角度;
第七旋转单元,用于当2区和3区存在的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和4区存在的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离大于3区内的障碍物与机器人的实际最小距离,则机器人右旋转预置角度;
第八旋转单元,用于当2区和3区内的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,1区和4区的障碍物与机器人的实际最小距离都大于所述预置第二安全距离,且2区存在的障碍物与机器人的实际最小距离小于3区内的障碍物与机器人的实际最小距离,则机器人左旋转预置角度;
第九旋转单元,用于当只有1区的障碍物与机器人的实际最小距离值大于所述预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于所述预置第二安全距离,机器人右旋转预置角度;
第十旋转单元,用于当只有4区内的障碍物与机器人的实际最小距离值大于所述预置第二安全距离值,其余三个区内的障碍物与机器人的实际最小距离都小于所述预置第二安全距离,则机器人左旋转预置角度;
第十一旋转单元,用于当四个区内的障碍物与机器人的实际最小距离值小于所述预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值大于4区内的障碍物与机器人的实际最小距离值,机器人右旋转预置角度;
第十二旋转单元,用于当四个区内的障碍物与机器人的的实际最小距离值小于所述预置第二安全距离值,且1区内的障碍物与机器人的实际最小距离值小于4区内的障碍物与机器人的实际最小距离值,则机器人左旋转预置角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111533754.XA CN114415662B (zh) | 2021-12-15 | 2021-12-15 | 一种智能机器人避障方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111533754.XA CN114415662B (zh) | 2021-12-15 | 2021-12-15 | 一种智能机器人避障方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114415662A true CN114415662A (zh) | 2022-04-29 |
CN114415662B CN114415662B (zh) | 2023-10-17 |
Family
ID=81267976
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111533754.XA Active CN114415662B (zh) | 2021-12-15 | 2021-12-15 | 一种智能机器人避障方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114415662B (zh) |
Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009037378A (ja) * | 2007-08-01 | 2009-02-19 | Panasonic Corp | 自律走行装置およびプログラム |
US20140152822A1 (en) * | 2012-12-05 | 2014-06-05 | Florida Institute for Human and Machine Cognition | User Display Providing Obstacle Avoidance |
CN205139699U (zh) * | 2015-10-12 | 2016-04-06 | 深圳市德宝威科技有限公司 | 机器人避障系统 |
CN105487536A (zh) * | 2014-10-13 | 2016-04-13 | 北京自动化控制设备研究所 | 一种移动机器人的低成本自主避障方法 |
CN105676845A (zh) * | 2016-01-19 | 2016-06-15 | 中国人民解放军国防科学技术大学 | 一种智能安保服务机器人复杂环境避障方法及安保服务机器人 |
CN106054889A (zh) * | 2016-06-28 | 2016-10-26 | 旗瀚科技股份有限公司 | 一种机器人自主避障方法和装置 |
CN106313046A (zh) * | 2016-09-27 | 2017-01-11 | 成都普诺思博科技有限公司 | 移动机器人多级避障系统 |
CN107562048A (zh) * | 2017-08-08 | 2018-01-09 | 浙江工业大学 | 一种基于激光雷达的动态避障控制方法 |
CN108181904A (zh) * | 2017-12-29 | 2018-06-19 | 深圳市艾特智能科技有限公司 | 机器人避障方法、系统、可读存储介质及机器人 |
US20180267170A1 (en) * | 2017-03-17 | 2018-09-20 | Sharp Kabushiki Kaisha | Obstacle detection device, traveling apparatus, obstacle detection system, and obstacle detection method |
CN108958267A (zh) * | 2018-08-10 | 2018-12-07 | 洛阳中科龙网创新科技有限公司 | 一种基于激光雷达的无人车避障方法 |
CN109397299A (zh) * | 2017-08-15 | 2019-03-01 | 上海宜硕网络科技有限公司 | 机器人、机器人服务管理系统以及机器人的移动控制方法 |
CN109765908A (zh) * | 2018-03-19 | 2019-05-17 | 徐州艾奇机器人科技有限公司 | 一种六轮驱动快速无人驾驶巡逻车系统及工作方法 |
EP3549726A2 (en) * | 2016-11-30 | 2019-10-09 | Yujin Robot Co., Ltd. | Robotic vacuum cleaner, cleaning function control apparatus equipped in robotic vacuum cleaner, and multi-channel lidar-based obstacle detection apparatus equipped in robotic vacuum cleaner |
US20200081440A1 (en) * | 2018-09-06 | 2020-03-12 | Kabushiki Kaisha Toyota Jidoshokki | Autonomous travel cart and method of controlling travel thereof |
CN111781606A (zh) * | 2020-07-02 | 2020-10-16 | 大唐信通(浙江)科技有限公司 | 一种新型激光雷达和超声波雷达融合的小型化实现方法 |
CN113110515A (zh) * | 2021-05-20 | 2021-07-13 | 深圳市邻友通科技发展有限公司 | 一种移动机器人避障方法、装置、设备及存储介质 |
CN113485381A (zh) * | 2021-08-24 | 2021-10-08 | 山东新一代信息产业技术研究院有限公司 | 一种基于多传感器的机器人移动系统及方法 |
-
2021
- 2021-12-15 CN CN202111533754.XA patent/CN114415662B/zh active Active
Patent Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009037378A (ja) * | 2007-08-01 | 2009-02-19 | Panasonic Corp | 自律走行装置およびプログラム |
US20140152822A1 (en) * | 2012-12-05 | 2014-06-05 | Florida Institute for Human and Machine Cognition | User Display Providing Obstacle Avoidance |
CN105487536A (zh) * | 2014-10-13 | 2016-04-13 | 北京自动化控制设备研究所 | 一种移动机器人的低成本自主避障方法 |
CN205139699U (zh) * | 2015-10-12 | 2016-04-06 | 深圳市德宝威科技有限公司 | 机器人避障系统 |
CN105676845A (zh) * | 2016-01-19 | 2016-06-15 | 中国人民解放军国防科学技术大学 | 一种智能安保服务机器人复杂环境避障方法及安保服务机器人 |
CN106054889A (zh) * | 2016-06-28 | 2016-10-26 | 旗瀚科技股份有限公司 | 一种机器人自主避障方法和装置 |
CN106313046A (zh) * | 2016-09-27 | 2017-01-11 | 成都普诺思博科技有限公司 | 移动机器人多级避障系统 |
EP3549726A2 (en) * | 2016-11-30 | 2019-10-09 | Yujin Robot Co., Ltd. | Robotic vacuum cleaner, cleaning function control apparatus equipped in robotic vacuum cleaner, and multi-channel lidar-based obstacle detection apparatus equipped in robotic vacuum cleaner |
US20180267170A1 (en) * | 2017-03-17 | 2018-09-20 | Sharp Kabushiki Kaisha | Obstacle detection device, traveling apparatus, obstacle detection system, and obstacle detection method |
CN107562048A (zh) * | 2017-08-08 | 2018-01-09 | 浙江工业大学 | 一种基于激光雷达的动态避障控制方法 |
CN109397299A (zh) * | 2017-08-15 | 2019-03-01 | 上海宜硕网络科技有限公司 | 机器人、机器人服务管理系统以及机器人的移动控制方法 |
CN108181904A (zh) * | 2017-12-29 | 2018-06-19 | 深圳市艾特智能科技有限公司 | 机器人避障方法、系统、可读存储介质及机器人 |
CN109765908A (zh) * | 2018-03-19 | 2019-05-17 | 徐州艾奇机器人科技有限公司 | 一种六轮驱动快速无人驾驶巡逻车系统及工作方法 |
CN108958267A (zh) * | 2018-08-10 | 2018-12-07 | 洛阳中科龙网创新科技有限公司 | 一种基于激光雷达的无人车避障方法 |
US20200081440A1 (en) * | 2018-09-06 | 2020-03-12 | Kabushiki Kaisha Toyota Jidoshokki | Autonomous travel cart and method of controlling travel thereof |
CN111781606A (zh) * | 2020-07-02 | 2020-10-16 | 大唐信通(浙江)科技有限公司 | 一种新型激光雷达和超声波雷达融合的小型化实现方法 |
CN113110515A (zh) * | 2021-05-20 | 2021-07-13 | 深圳市邻友通科技发展有限公司 | 一种移动机器人避障方法、装置、设备及存储介质 |
CN113485381A (zh) * | 2021-08-24 | 2021-10-08 | 山东新一代信息产业技术研究院有限公司 | 一种基于多传感器的机器人移动系统及方法 |
Non-Patent Citations (3)
Title |
---|
向亚军,严华: "基于激光雷达的移动机器人避障策略研究", 四川大学学报(自然科学版), vol. 54, no. 3, pages 529 - 534 * |
李卫硕;孙剑;陈伟;: "基于BP神经网络机器人实时避障算法", 仪器仪表学报, no. 11 * |
胡铖锟;陈致格;晏泉;王晶;: "基于坐姿传感及自主避障的轮椅控制系统", 安徽工业大学学报(自然科学版), vol. 37, no. 3, pages 280 - 288 * |
Also Published As
Publication number | Publication date |
---|---|
CN114415662B (zh) | 2023-10-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9684055B2 (en) | Method and apparatus for using gestures to control a laser tracker | |
CN110770600B (zh) | 分布式光检测和测距(lidar)管理系统 | |
JPH07306042A (ja) | セルラ構造の周辺地図の作成方法および装置 | |
WO2018131237A1 (ja) | 協働ロボットシステム、及びその制御方法 | |
KR20000062430A (ko) | 물체와 위치 가변성 장치 사이의 직각 위치를 특정하는 방법 | |
US20120065829A1 (en) | Wall-following Moving Device | |
EP3611589B1 (en) | Method for controlling motion of robot based on map prediction | |
KR20060068968A (ko) | 비콘을 이용하여 위치 및 방향 인식이 가능한 로봇시스템 | |
JP2000056006A (ja) | 移動体の位置認識装置 | |
CN106226772B (zh) | 一种基于超声波传感器的运动物体识别方法 | |
JPH01287415A (ja) | 自走車の位置制御装置 | |
CN114415662B (zh) | 一种智能机器人避障方法及装置 | |
WO2019127977A1 (zh) | 多线激光测距装置以及机器人 | |
KR101165969B1 (ko) | 거리 및 각도측정 기능을 갖는 위치측정장치 | |
KR100443953B1 (ko) | 무선신호를 이용한 로봇의 상대적 위치 추정 장치 및 방법 | |
JP3867334B2 (ja) | 建築用自律移動ロボット | |
Li et al. | Position estimation and error correction of mobile robots based on UWB and multisensors | |
JPS58201080A (ja) | 移動体の位置検出方法 | |
Karakaya et al. | Development of a human tracking indoor mobile robot platform | |
Wang et al. | Research on robot obstacle avoidance method on PSD and sonar sensors | |
US20120063269A1 (en) | Rotary type distance estimation apparatus and moving body including the same | |
Tatsis et al. | Design and implementation of obstacle detection system for powered wheelchairs | |
KR20220104778A (ko) | 자율 이동 장치 및 그것의 거리 측정 방법 | |
Saxena et al. | Search and rescue operations using robots demonstrating swarm behaviour | |
Micea et al. | Distance measurement for indoor robotic collectives |
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 |