CN112684803A - 移动机器人的控制方法、装置、移动机器人和存储介质 - Google Patents
移动机器人的控制方法、装置、移动机器人和存储介质 Download PDFInfo
- Publication number
- CN112684803A CN112684803A CN202110263046.2A CN202110263046A CN112684803A CN 112684803 A CN112684803 A CN 112684803A CN 202110263046 A CN202110263046 A CN 202110263046A CN 112684803 A CN112684803 A CN 112684803A
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- distance
- road section
- slope
- angle
- 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 49
- 230000009194 climbing Effects 0.000 claims abstract description 20
- 238000005259 measurement Methods 0.000 claims description 31
- 230000015654 memory Effects 0.000 claims description 17
- 238000006073 displacement reaction Methods 0.000 claims description 10
- 230000001174 ascending effect Effects 0.000 claims description 7
- 238000004590 computer program Methods 0.000 claims description 7
- 238000010586 diagram Methods 0.000 description 10
- 230000002159 abnormal effect Effects 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000008707 rearrangement Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
- G05D1/0236—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons 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/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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Q—ARRANGEMENT OF SIGNALLING OR LIGHTING DEVICES, THE MOUNTING OR SUPPORTING THEREOF OR CIRCUITS THEREFOR, FOR VEHICLES IN GENERAL
- B60Q5/00—Arrangement or adaptation of acoustic signal devices
- B60Q5/005—Arrangement or adaptation of acoustic signal devices automatically actuated
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C9/00—Measuring inclination, e.g. by clinometers, by levels
- G01C9/02—Details
- G01C9/06—Electric or photoelectric indication or reading means
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
-
- 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/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- 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/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/027—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
-
- 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)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Optics & Photonics (AREA)
- Mechanical Engineering (AREA)
- Acoustics & Sound (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Navigation (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
本申请实施例提供一种移动机器人的控制方法、装置、移动机器人和存储介质,通过当激光雷达获得的距离信息发生有效距离变化时,预测前方路段相对移动机器人当前所在路面的倾斜角度;基于所述倾斜角度和所述俯仰角度,确定前方路段的坡度;根据所述坡度、所述坡度与所述移动机器人设定的坡度阈值的比较结果,控制所述移动机器人运动;将所述前方路段在坡度地图上标记为坡度区域,所述坡度地图用于当所述移动机器人经过所述坡度区域,根据所述坡度区域,控制所述移动机器人发出爬坡警示信息,使移动机器能够在具有上下坡的路段中运行,提升了移动机器人性能,拓宽了移动机器人的应用场景。
Description
技术领域
本申请实施例涉及机器人技术领域,尤其涉及一种移动机器人的控制方法、装置、移动机器人和存储介质。
背景技术
随着机器人技术的迅速发展,移动机器人的应用领域越来越广泛,为了实现对移动机器人在未知环境中的运动控制和导航,基于视觉的机器人障碍物识别倍受的关注,已成为近年来移动机器人的研究热点之一。
现有技术中,通过设置于移动机器人下部区域的激光雷达360°旋转扫描,识别周围空间中的障碍物,由于激光雷达距离地面通常有一定的高度,导致现有技术中的移动机器人无法获得路面信息,从而只能在平整的地面上运行。
因此,如何控制移动机器在具有上下坡的路段中运行成为现有技术中亟需解决的技术问题。
发明内容
本申请实施例提供一种移动机器人的控制方法、装置、移动机器人和存储介质,使移动机器能够在具有上下坡的路段中运行。
第一方面,本申请实施例提供一种移动机器人的控制方法,所述移动机器人上安装有激光雷达和惯性测量单元,所述激光雷达用于测量所述激光雷达距离路面的距离,所述惯性测量单元用于测量所述移动机器人当前的俯仰角度,所述方法包括:
当所述激光雷达获得的距离信息发生有效距离变化时,预测前方路段相对所述移动机器人当前所在路面的倾斜角度;
基于所述倾斜角度和所述俯仰角度,确定前方路段的坡度;
根据所述坡度、所述坡度与所述移动机器人的坡度阈值的比较结果,控制所述移动机器人运动;
将所述前方路段在坡度地图上标记为坡度区域,所述坡度地图用于当所述移动机器人经过所述坡度区域,根据所述坡度区域,控制所述移动机器人发出爬坡警示信息。
可选地,所述预测前方路段相对所述移动机器人当前所在路面的倾斜角度,包括:
获取所述激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离;
根据所述固定距离和所述测量距离,计算所述前方路段相对当前路面的倾斜角度。
可选地,所述激光雷达为单线雷达,所述根据所述固定距离和所述测量距离,计算所述前方路段相对当前路面的倾斜角度,包括:
确定所述移动机器人从所述第一位置移动到所述第二位置的位移;
根据所述位移、所述固定距离、所述测量距离和光线发射角,计算所述前方路段相对当前路面的倾斜角度,所述光线发射角是所述激光雷达发射的光束与路面的夹角。
可选地,所述激光雷达为多线雷达,所述获取所述激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离,包括:
获取所述激光雷达发射的第一光束和第二光束在第一位置测得的距离当前路面的第一固定距离和第二固定距离;
获取所述激光雷达发射的第一光束和第二光束在第二位置测得的距离前方路段的第一测量距离和第二测量距离;
相应地,所述根据所述固定距离和所述测量距离,计算所述前方路段相对当前路面的倾斜角度,包括:
根据所述第一固定距离、所述第二固定距离、所述第一测量距离、所述第二测量距离和光束夹角,计算所述前方路段相对当前路面的倾斜角度,所述光束夹角是所述第一光束与所述第二光束之间的夹角。
可选地,所述坡度阈值包括最大上坡角度和最小下坡角度,所述根据所述坡度、所述坡度与所述移动机器人的坡度阈值的比较结果,控制所述移动机器人运动,包括:
根据所述坡度的正负情况,确定所述前方路段的上下坡情况,所述上下坡情况为上坡路段或下坡路段;
若所述前方路段为上坡路段,则确定所述坡度是否小于所述最大上坡角度;
若所述坡度小于所述最大上坡角度,则控制所述移动机器人上坡。
可选地,所述控制所述移动机器人上坡,包括:
确定所述坡度与所述俯仰角度的大小关系,所述大小关系为大于、小于或等于;
若所述坡度大于所述俯仰角度,则增大所述移动机器人的牵引力;
若所述坡度小于所述俯仰角度,则增大所述移动机器人的速度;
若所述坡度等于所述俯仰角度,则保持所述移动机器人的牵引力和速度不变。
可选地,所述方法还包括:
若所述前方路段为下坡路段,则确定所述坡度是否大于所述最小下坡角度;
若所述坡度大于所述最小下坡角度,则控制所述移动机器人下坡。
可选地,所述方法还包括:
对所述激光雷达的测量距离大于距离阈值的数据进行去除,并对测量距离进行拟合获得所述距离信息。
可选地,所述爬坡警示信息包括语音提醒或灯光提醒。
可选地,所述方法还包括:
当所述移动机器人经过所述坡度区域时,若基于所述倾斜角度和所述俯仰角度,确定前方路段无坡度,则将该坡度区域进行更新。
第二方面,本申请实施例提供一种移动机器人的控制装置,包括:
坡度预测模块,用于当所述激光雷达获得的距离信息发生有效距离变化时,预测前方路段相对所述移动机器人当前所在路面的倾斜角度;基于所述倾斜角度和惯性测量单元测得的俯仰角度,确定前方路段的坡度;
运动控制模块,用于根据所述坡度、所述坡度与所述移动机器人设定的坡度阈值的比较结果,控制所述移动机器人运动;将所述前方路段在坡度地图上标记为坡度区域,所述坡度地图用于当所述移动机器人经过所述坡度区域,根据所述坡度区域,控制所述移动机器人发出爬坡警示信息。
第三方面,本申请实施例提供一种移动机器人,包括:
激光雷达,用于测量所述激光雷达距离路面的距离;
惯性测量单元,用于测量所述移动机器人当前的俯仰角度;
数据处理中心,包括:存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现如上述第一方面所述的移动机器人的控制方法。
第四方面,本申请实施例提供一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现如上述第一方面所述的移动机器人的控制方法。
本申请实施例提供的移动机器人的控制方法、装置、移动机器人和存储介质,通过当激光雷达获得的距离信息发生有效距离变化时,预测前方路段相对移动机器人当前所在路面的倾斜角度;基于所述倾斜角度和所述俯仰角度,确定前方路段的坡度;根据所述坡度、所述坡度与所述移动机器人设定的坡度阈值的比较结果,控制所述移动机器人运动;将所述前方路段在坡度地图上标记为坡度区域,所述坡度地图用于当所述移动机器人经过所述坡度区域,根据所述坡度区域,控制所述移动机器人发出爬坡警示信息,使移动机器能够在具有上下坡的路段中运行,提升了移动机器人性能,拓宽了移动机器人的应用场景。
附图说明
图1为本申请实施例的一种应用场景示意图;
图2为本申请实施例一提供的移动机器人的控制方法的流程示意图;
图3为本申请实施例一提供的基于单线雷达的移动机器人的上坡示意图;
图4为本申请实施例一提供的基于单线雷达的移动机器人的下坡示意图;
图5为本申请实施例一提供的基于多线雷达的移动机器人的上坡示意图;
图6为本申请实施例一提供的基于多线雷达的移动机器人的下坡示意图;
图7为本申请实施例二提供的移动机器人的控制装置的结构示意图;
图8为本申请实施例三提供的一种移动机器人的结构示意图。
具体实施方式
下面结合附图和实施例对本申请作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本申请,而非对本申请的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本申请相关的部分而非全部结构。
本申请技术方案的主要思路:示例性地,图1为本申请实施例的一种应用场景示意图,如图1所示,移动机器人上安装有激光雷达和惯性测量单元(inertial measurementunit,IMU),激光雷达和惯性测量单元均平行于移动机器人的底盘安装,激光雷达的出射光线与地面的夹角为θ,激光雷达用于测量激光雷达距离路面的距离,惯性测量单元用于测量移动机器人当前的俯仰角度,即当前路面的倾斜角度。本申请实施例提供一种控制移动机器人运动的技术方案,在机器人移动过程中,通过激光雷达持续探测距离前方路段的距离,由于激光雷达的安装位置及相对地面的角度固定,在地面平整的情况下,激光雷达测得的距离值近似为定值,当前方路段出现坡度时,距离值会发生变化,因此本实施例中通过对距离值进行监测,当监测到距离值发生变化时,获取IMU测得的移动机器人的俯仰角度及激光雷达测得的距离值,根据俯仰角度和距离值,对前方路段的坡度进行预测,并根据预测结果对控制移动机器人的运动,从而使移动机器人能够安全地通过上下坡路段,在现有移动机器人的硬件基础上,提升了移动机器人性能。
实施例一
图2为本申请实施例一提供的移动机器人的控制方法的流程示意图,本实施例的方法可以由本申请实施例所提供的移动机器人的控制装置执行,该装置可以由软件和/或硬件的方式来实现,并可集成于移动机器人中。如图2所示,本实施例的移动机器人的控制方法,包括:
S101、当激光雷达获得的距离信息发生有效距离变化时,预测前方路段相对移动机器人当前所在路面的倾斜角度。
示例性地,假设移动机器人在水平路面(当前路面)上运动时,激光雷达测得的距离用d 0 表示,当遇到上坡时,测得的距离d 1 < d 0 ,当遇到下坡时,测得的距离d 2 > d 0 ,相反,若移动机器人持续运动一段距离,测得的距离d均满足d < d 0 或d > d 0 ,则可说明前方有斜坡,为保证机器人能够顺利通过斜坡,本步骤中,需要对前方路段相对当前路面的倾斜角度进行预测。
其中,有效距离变化,可用于确定路面是否发生坡度变化的距离变化,一方面,是指超过一定范围或数量级的变化,如厘米级,对于一些小于设定阈值或数量级的微小的变化可以忽略不计;另一方面,是持续测量几次(如大于3次)得到的距离值相对于一个相对固定的距离值的变化,如假设激光雷达的采样周期为1s,在机器人运动的0-5min中,测得的距离均为d 0 ,从第5min开始,持续测得的10个距离值均小于d 0 ,则确定激光雷达测得的距离发生了有效距离变化,若持续测得的2个距离值小于d 0 ,之后持续测得的距离值又恢复为d 0 ,则可以忽略该变化。
可选地,本步骤中,可以通过对激光雷达测得的距离中的异常点(如距离值大于10*d 0 的测量距离)进行算法剔除,因为机器人的场景基本确定,如果测得距离远大于和平面路段的距离,则大概率发生激光没有照射到路面或者被地面异物造成光线干扰,导致测量结果异常,对测量距离进行拟合获得距离信息,再根据处理结果判断是否发生有效距离变化。从而提高对坡度的判断的准确性。
可选地,本步骤中,当激光雷达测得的距离信息发生有效距离变化时,通过获取激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离,并根据该固定距离和测量距离,计算前方路段相对当前路面的倾斜角度。
具体地,当确定激光雷达测得的距离发生有效距离变化时,从发生有效距离变化之前,激光雷达进行距离测量的位置中选取一个位置,作为第一位置,并获取激光雷达在第一位置测量的距离值,得到固定距离,从发生有效距离变化之后,激光雷达进行距离测量的位置中选取一个位置,作为第二位置,并获取激光雷达在第二位置测量的距离值,得到测量距离,再将固定距离和测量距离的实际数值,代入预先设计的算法中进行求解,得到前方路段相对当前路面的倾斜角度。
由于本申请实施例中的激光雷达可以为单线雷达,也可以为多线雷达,为此本申请实施例中针对单线雷达和多线雷达设计了不同算法,对倾斜角度进行预测,以满足对安装有不同激光雷达的移动机器人的控制需求。
(1)单线雷达
确定所述移动机器人从第一位置移动到第二位置的位移;根据位移、固定距离、测量距离和光线发射角,计算前方路段相对当前路面的倾斜角度,其中,光线发射角是激光雷达发射的光束与路面的夹角(图1中的θ)。
a、上坡方案
示例性地,图3为本申请实施例一提供的基于单线雷达的移动机器人的上坡示意图,假设移动机器人在当前路面上行驶过程中,激光雷达在第一位置(P点)测得的距离当前路面的距离(固定距离)表示为d 0 ,在第二位置(Q点)测得的距离前方路段的距离(测量距离)表示为d 1 ,移动机器人从第一位置运动到第二位置的位移用S表示,光线发射角为θ,即PQ=S,PB= d 0 ,QA= d 1 。
在平行四边形PQCB中,由平行四边形法则,可知:BC=PQ=S,AC=QC-QA=PB-QA=S- d 1 ,∠α = ∠θ;
在三角形ABC中,由余弦定理和正弦定理,可知:
AB² = BC² + AC² - 2*BC *AC *cosα (1)
AB / sinα = AC / sinβ (2)
将BC、AC、α值代入上述公式(1)和(2)中,进行求解,就可以得到β,β即为前方路段相对当前路面的倾斜角度的数值。
对于β的正负,若固定距离大于测量距离,则β取正,若固定距离小于测量距离,则β取负,如在图3中,当边PB大于QA,则β取正;当边PB小于QA,则β取负。
b、下坡方案
示例性地,图4为本申请实施例一提供的基于单线雷达的移动机器人的下坡示意图,假设移动机器人在当前路面上行驶过程中,激光雷达在第一位置(P点)测得的距离当前路面的距离(固定距离)表示为d 0 ,在第二位置(Q点)测得的距离前方路段的距离(测量距离)表示为d 2 ,移动机器人从第一位置运动到第二位置的位移用S表示,光线发射角为θ,即PQ = S,PB = d 0 ,QA = d 2 ,BC=PQ=S,QC=PB = d 0 ,AC=QA-QC= QC-QA= d 2 - d 0 ,∠α = 180°-∠θ。
在三角形ABC中,由余弦定理和正弦定理,可知:
AB² = BC² + AC² - 2 BC*AC *cosα (3)
AB / sinα = AC / sinβ (4)
将BC、AC、α值代入上述公式(3)和(4)中,进行求解,就可以得到β,β即为前方路段相对当前路面的倾斜角度的数值。
β的正负定义与前述相同,此处不再赘述。
需要说明的是,在一种可能的实施方式中,上述单线雷达的上坡方案和下坡方案中,P点为坡道变化交点对应的移动机器人的位置。
由于移动机器人在运行过程中,激光雷达会按照一定的频率实时采集距离地面的距离信息,得到许多的距离数据及对应的移动机器人的位置数据,因此,通过对这些距离数据进行分析,识别出坡道变化交点,如图3-4中的B点,就得到坡道变化交点对应的移动机器人的位置,通过以该位置作为P点,并采用上述对应的计算方法,就可以计算出前方路段相对当前路面的倾斜角度。
(2)多线雷达
获取激光雷达发射的第一光束和第二光束在第一位置测得的距离当前路面的第一固定距离和第二固定距离;获取激光雷达发射的第一光束和第二光束在第二位置测得的距离前方路段的第一测量距离和第二测量距离;根据第一固定距离、第二固定距离、第一测量距离、第二测量距离和光束夹角,计算前方路段相对当前路面的倾斜角度,其中,光束夹角是第一光束与第二光束之间的夹角。
a、上坡方案
示例性地,图5为本申请实施例一提供的基于多线雷达的移动机器人的上坡示意图,假设移动机器人在当前路面上行驶过程中,在第一位置(P点)处,激光雷达发射的第一光束和第二光束测得的距离当前路面的距离(固定距离)表分别为l 1 和l 2 ,第一光束和第二光束之间的夹角(光束夹角)为θ,在第二位置(Q点)处,激光雷达发射的第一光束和第二光束测得的距离前方路段的距离测分别为s 1 和s 2 ,光束夹角不变,即QB = s 1 ,QA = s 2 ,QM =l 1 ,QN = l 2 ,∠AQB = ∠NQM = ∠θ,∠QMC = ∠QBA = ∠α,∠CMN = ∠ADN = ∠β。
在三角形QAB中,由余弦定理和正弦定理,可知:
AB ² = QA² + QB² - 2* QA * QB *cosθ (5)
AB / sinθ = QA / sinα (6)
将QA、QB、θ值代入上述公式(5)和(6)中,就可以求出α;
在三角形QMN中,由余弦定理和正弦定理,可知:
MN² = QM² + QN² - 2* QM * QN *cosθ (7)
MN / sinθ = QN / sinγ (8)
γ=α+β (9)
将QM、QN和α代入上述公式(7)-(9)中,进行求解,就可以得到β,β即为前方路段相对当前路面的倾斜角度的数值。
β的正负定义与前述相同,此处不再赘述
b、下坡方案
示例性地,图6为本申请实施例一提供的基于多线雷达的移动机器人的下坡示意图,假设移动机器人在当前路面上行驶过程中,在第一位置(P点)处,激光雷达发射的第一光束和第二光束测得的距离当前路面的距离(固定距离)表分别为l 1 和l 2 ,第一光束和第二光束之间的夹角(光束夹角)为θ,在第二位置(Q点)处,激光雷达发射的第一光束和第二光束测得的距离前方路段的距离测分别为s 1 和s 2 ,光束夹角不变,即QM = s 1 ,QN = s 2 ,QB =l 1 ,QA = l 2 ,∠AQB = ∠NQM = ∠θ,∠QMC = ∠QBA = ∠α,∠CMN = ∠ADN = ∠β。
在三角形QAB中,由余弦定理和正弦定理,可知:
AB ² = QA² + QB² - 2* QA * QB *cosθ (10)
AB / sinθ = QA / sinα (11)
将QA、QB、θ值代入上述公式(10)和(11)中,就可以求出α;
在三角形QMN中,由余弦定理和正弦定理,可知:
MN² = QM² + QN² - 2* QM * QN *cosθ (12)
MN / sinθ = QN / sinγ (13)
γ=α+β (14)
将QM、QN和α代入上述公式(12)-(14)中,进行求解,就可以得到β,β即为前方路段相对当前路面的倾斜角度的数值。
β的正负定义与前述相同,此处不再赘述。
S102、基于倾斜角度和俯仰角度,确定前方路段的坡度。
本步骤中,根据S101计算得到的倾斜角度和IMU测得的俯仰角度,确定前方路段的坡度,其中,前方路段的坡度是指前方路段相对水平路面的倾斜角度,坡度也有正负,坡度为正,表示前方路段为上坡路段,坡度为负,表示前方路段的为下坡路段。
可选地,本实施例中,通过如下公式确定前方路段的坡度:
Σ = β + δ (15)
其中,Σ表示坡度,δ表示俯仰角度,β表示倾斜角度。
可以理解的是,俯仰角度δ也有正负之分,当移动机器人当前所在路面为上坡路段时,δ为正,当移动机器人当前所在路面为下坡路段时,δ为负。
S103、根据坡度、坡度与移动机器人的坡度阈值的比较结果,控制移动机器人运动。
本步骤中,根据S102中确定的前方路段的坡度和移动机器人的爬坡性能,确定是机器人是否能够继续前行,若能继续前行,则控制移动机器人上坡或下坡,若不能继续前行,则控制控制移动制动或原路返回。
其中,爬坡能力是根据移动机器人的硬件条件和机械性能确定的移动机器人上下坡能力,可以通过坡度阈值或最大输出动能等来进行描述。
以坡度阈值为例,假设坡度阈值包括最大上坡角度和最小下坡角度,本实施例中,首先,根据坡度的正负情况,确定前方路段的上下坡情况,若坡度为正,则说明前方路段为上坡路段;若坡度为负,则说明前方路段为下坡路段;若坡度为零,则说明前方为水平路段;进一步地,根据前方路段的上下坡情况,控制移动机器人上坡或下坡,具体地:
(1)若前方路段为上坡路段,则确定该坡度是否小于最大上坡角度,若否,则说明前方路段的坡度超过了移动机器上的爬坡能力,若继续上坡,则有可能出现滑倒等安全事故,应控制移动机器人制动或原路返回,若是,则控制移动机器人上坡。
本实施例中,可以根据坡度的变化情况,对移动机器的速度或牵引力等进行控制,以控制移动机器人安全、高效地上坡。在一种可能的实施方式中,本实施例中,确定坡度与俯仰角度的大小关系,大小关系为大于、小于或等于,若坡度大于俯仰角度,则说明坡度变陡,需要增大移动机器人的牵引力,以保证移动机器人能够顺利上坡,若坡度小于俯仰角度,则说明坡度变缓,可以适当增大移动机器人的速度,以使移动机器人快速通过,若坡度等于俯仰角度,则说明坡度没有发生变化,可以保持移动机器人的牵引力和速度不变。
(2)若前方路段为下坡路段,则确定该坡度是否小于最小下坡角度,若否,则说明前方路段的坡度超过了移动机器上的爬坡能力,若继续下坡,则有可能出现滑倒等安全事故,应控制移动机器人制动或原路返回,若是,则控制移动机器人下坡。
本实施例中,可以根据坡度的变化情况,对移动机器的速度或牵引力等进行控制,以控制移动机器人安全、高效地下坡。在一种可能的实施方式中,本实施例中,确定坡度与俯仰角度的大小关系,大小关系为大于、小于或等于,若坡度大于俯仰角度,则说明坡度变缓,可以适当增大移动机器人的牵引力,以保证移动机器人移动所需的动力,若坡度小于俯仰角度,则说明坡度变陡,需要减小移动机器人的速度,以保证移动机器人的安全,若坡度等于俯仰角度,则说明坡度没有发生变化,可以保持移动机器人的牵引力和速度不变。
(3)若前方路段为水平路段,则确定该坡度与俯仰角度的大小关系,大小关系为大于或小于,若该坡度大于俯仰角度,则可以减小移动机器人的牵引动力,为移动机器提供满足水平路段运行所需的动力即可,若坡度小于俯仰角度,则可以适当增加移动机器人的速度,以保证移动机器人的可以快速通过水平路段。
需要说明的是,上述实施方式中,俯仰角度、倾斜角度和坡度均是带正负号的,因此,在比较大小时,也是在带有正负号的情况下进行比较的。
S104、将前方路段在坡度地图上标记为坡度区域。
本实施例中的移动机器人具有坡度信息学习能力,在移动机器人行走过程中,设置于移动机器人中的数据处理中心可以根据经过路段的坡度情况,生成坡度地图,坡度地图上包括坡度区域、水平路段区域或未标记区域等,当移动机器人经过所述坡度区域,根据坡度区域,控制移动机器人发出爬坡警示信息,爬坡警示信息可以为语音提醒或灯光提醒等,如“注意机器人上坡,请注意避让”,从而达到提醒行人的目的,以保障道路通行安全。
可以理解的是,由于施工等原因,地面的坡度也是动态变化的,因此,当移动机器人经过坡度地图上标记的某坡度区域时,若基于测得的倾斜角度和俯仰角度,确定前方路段实际没有坡度,则对坡度地图上的坡度区域进行更新,从而提高坡度地图的准确性和实用性,进而提高移动机器人的控制准确性。
可选地,对于坡度区域还可以在坡度地图上标记坡度值、上下坡、斜坡长度等坡度信息。从而可以根据坡度地图和定位技术,当发现移动机器人经过坡度区域时,根据坡度信息控制移动机器人运动,以使移动机器人提前调整运行速度提高移动机器人的智能化程度。
本实施例中,通过当激光雷达获得的距离信息发生有效距离变化时,预测前方路段相对移动机器人当前所在路面的倾斜角度;基于所述倾斜角度和所述俯仰角度,确定前方路段的坡度;根据所述坡度、所述坡度与所述移动机器人设定的坡度阈值的比较结果,控制所述移动机器人运动;将所述前方路段在坡度地图上标记为坡度区域,所述坡度地图用于当所述移动机器人经过所述坡度区域,根据所述坡度区域,控制所述移动机器人发出爬坡警示信息,使移动机器能够在具有上下坡的路段中运行,提升了移动机器人性能,拓宽了移动机器人的应用场景。
实施例二
图7为本申请实施例二提供的移动机器人的控制装置的结构示意图,如图7所示,本实施例中移动机器人的控制装置10包括:
坡度预测模块11和运动控制模块12。
坡度预测模块11,用于当所述激光雷达获得的距离信息发生有效距离变化时,预测前方路段相对所述移动机器人当前所在路面的倾斜角度;基于所述倾斜角度和惯性测量单元测得的俯仰角度,确定前方路段的坡度;
运动控制模块12,用于根据所述坡度、所述坡度与所述移动机器人的坡度阈值的比较结果,控制所述移动机器人运动;将所述前方路段在坡度地图上标记为坡度区域,所述坡度地图用于当所述移动机器人经过所述坡度区域,根据所述坡度区域,控制所述移动机器人发出爬坡警示信息。
可选地,坡度预测模块11具体用于:
获取所述激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离;
根据所述固定距离和所述测量距离,计算所述前方路段相对当前路面的倾斜角度。
可选地,所述激光雷达为单线雷达,坡度预测模块11具体用于:
确定所述移动机器人从所述第一位置移动到所述第二位置的位移;
根据所述位移、所述固定距离、所述测量距离和光线发射角,计算所述前方路段相对当前路面的倾斜角度,所述光线发射角是所述激光雷达发射的光束与路面的夹角。
可选地,所述激光雷达为多线雷达,坡度预测模块11具体用于:
获取所述激光雷达发射的第一光束和第二光束在第一位置测得的距离当前路面的第一固定距离和第二固定距离;
获取所述激光雷达发射的第一光束和第二光束在第二位置测得的距离前方路段的第一测量距离和第二测量距离;
相应地,所述根据所述固定距离和所述测量距离,计算所述前方路段相对当前路面的倾斜角度,包括:
根据所述第一固定距离、所述第二固定距离、所述第一测量距离、所述第二测量距离和光束夹角,计算所述前方路段相对当前路面的倾斜角度,所述光束夹角是所述第一光束与所述第二光束之间的夹角。
可选地,所述坡度阈值包括最大上坡角度和最小下坡角度,运动控制模块12具体用于:
根据所述坡度的正负情况,确定所述前方路段的上下坡情况,所述上下坡情况为上坡路段或下坡路段;
若所述前方路段为上坡路段,则确定所述坡度是否小于所述最大上坡角度;
若所述坡度小于所述最大上坡角度,则控制所述移动机器人上坡。
可选地,运动控制模块12具体用于:
确定所述坡度与所述俯仰角度的大小关系,所述大小关系为大于、小于或等于;
若所述坡度大于所述俯仰角度,则增大所述移动机器人的牵引力;
若所述坡度小于所述俯仰角度,则增大所述移动机器人的速度;
若所述坡度等于所述俯仰角度,则保持所述移动机器人的牵引力和速度不变。
可选地,运动控制模块12还用于:
若所述前方路段为下坡路段,则确定所述坡度是否大于所述最小下坡角度;
若所述坡度大于所述最小下坡角度,则控制所述移动机器人下坡。
可选地,运动控制模块12具体用于:
确定所述坡度与所述俯仰角度的大小关系,所述大小关系为大于、小于或等于;
若所述坡度大于所述俯仰角度,则增大所述移动机器人的牵引力;
若所述坡度小于所述俯仰角度,则减小所述移动机器人的速度;
若所述坡度等于所述俯仰角度,则保持所述移动机器人的牵引力和速度不变。
可选地,运动控制模块12还用于:
对所述激光雷达的测量距离大于距离阈值的数据进行去除,并对测量距离进行拟合获得所述距离信息。
可选地,所述爬坡警示信息包括语音提醒或灯光提醒。
可选地,运动控制模块12还用于:
当所述移动机器人经过所述坡度区域时,若基于所述倾斜角度和所述俯仰角度,确定前方路段无坡度,则将该坡度区域进行更新。
本实施例所提供的移动机器人的控制装置可执行上述方法实施例所提供的移动机器人的控制方法,具备执行方法相应的功能模块和有益效果。本实施例的实现原理和技术效果与上述方法实施例类似,此处不再一一赘述。
实施例三
图8为本申请实施例三提供的一种移动机器人的结构示意图,如图8所示,该移动机器人20包括:
激光雷达21、惯性测量单元22和数据处理中心23。激光雷达21、惯性测量单元22分别与数据处理中心23通信连接,以将采集的数据发送给数据处理中心23。
其中,激光雷达21可以为单线激光雷达,也可以为多线激光雷达。激光雷达平行于移动机器人的底盘安装,激光雷达发出的光束与水平地面呈固定夹角,用以测量所述激光雷达距离路面的距离。
惯性测量单元22,是通过加速度计和陀螺仪测量运动载体的方位与姿态的装置,本实施例中,惯性测量单元用于测量移动机器人当前的俯仰角度,即移动机器人相对水平面的倾斜角度。
数据处理中心23,包括:存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现如实施例一所述的移动机器人的控制方法。数据处理中心23中处理器的数量可以是一个或多个,处理器、存储器可以通过总线或其他方式连接。
存储器作为一种计算机可读存储介质,可用于存储软件程序、计算机可执行程序以及模块,如本申请实施例中的坡度预测模块11运动控制模块12对应的程序指令/模块。处理器通过运行存储在存储器中的软件程序、指令以及模块,从而移动机器人的各种功能应用以及数据处理,即实现上述的移动机器人的控制方法。
存储器可主要包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需的应用程序;存储数据区可存储根据终端的使用所创建的数据等。此外,存储器可以包括高速随机存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器件、闪存器件、或其他非易失性固态存储器件。在一些实例中,存储器可进一步包括相对于处理器远程设置的存储器,这些远程存储器可以通过网格连接至移动机器人。上述网格的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
实施例四
本申请实施例五还提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序在由计算机处理器执行时用于执行一种移动机器人的控制方法,该方法包括:
当所述激光雷达获得的距离信息发生有效距离变化时,预测前方路段相对所述移动机器人当前所在路面的倾斜角度;
基于所述倾斜角度和惯性测得单元测得的俯仰角度,确定前方路段的坡度;
根据所述坡度、所述坡度与所述移动机器人的坡度阈值的比较结果,控制所述移动机器人运动;
将所述前方路段在坡度地图上标记为坡度区域,所述坡度地图用于当所述移动机器人经过所述坡度区域,根据所述坡度区域,控制所述移动机器人发出爬坡警示信息。
当然,本申请实施例所提供的一种包计算机可读存储介质,其计算机程序不限于如上所述的方法操作,还可以执行本申请任意实施例所提供的移动机器人的控制方法中的相关操作。
通过以上关于实施方式的描述,所属领域的技术人员可以清楚地了解到,本申请可借助软件及必需的通用硬件来实现,当然也可以通过硬件实现,但很多情况下前者是更佳的实施方式。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如计算机的软盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(RandomAccess Memory,RAM)、闪存(FLASH)、硬盘或光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网格设备等)执行本申请各个实施例所述的方法。
值得注意的是,上述移动机器人的控制装置的实施例中,所包括的各个单元和模块只是按照功能逻辑进行划分的,但并不局限于上述的划分,只要能够实现相应的功能即可;另外,各功能单元的具体名称也只是为了便于相互区分,并不用于限制本申请的保护范围。
注意,上述仅为本申请的较佳实施例及所运用技术原理。本领域技术人员会理解,本申请不限于这里所述的特定实施例,对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本申请的保护范围。因此,虽然通过以上实施例对本申请进行了较为详细的说明,但是本申请不仅仅限于以上实施例,在不脱离本申请构思的情况下,还可以包括更多其他等效实施例,而本申请的范围由所附的权利要求范围决定。
Claims (12)
1.一种移动机器人的控制方法,其特征在于,所述移动机器人上安装有激光雷达和惯性测量单元,所述激光雷达用于测量所述激光雷达距离路面的距离,所述惯性测量单元用于测量所述移动机器人当前的俯仰角度,所述方法包括:
当所述激光雷达获得的距离信息发生有效距离变化时,根据所述激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离,预测前方路段相对所述移动机器人当前所在路面的倾斜角度;
基于所述倾斜角度和所述俯仰角度,确定前方路段的坡度;
根据所述坡度、所述坡度与所述移动机器人的坡度阈值的比较结果,控制所述移动机器人运动;
将所述前方路段在坡度地图上标记为坡度区域,所述坡度地图用于当所述移动机器人经过所述坡度区域,根据所述坡度区域,控制所述移动机器人发出爬坡警示信息。
2.根据权利要求1所述的方法,其特征在于,所述激光雷达为单线雷达,所述根据所述激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离,预测前方路段相对所述移动机器人当前所在路面的倾斜角度,包括:
获取所述激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离;
确定所述移动机器人从所述第一位置移动到所述第二位置的位移;
根据所述位移、所述固定距离、所述测量距离和光线发射角,计算所述前方路段相对当前路面的倾斜角度,所述光线发射角是所述激光雷达发射的光束与路面的夹角。
3.根据权利要求1所述的方法,其特征在于,所述激光雷达为多线雷达,所述根据所述激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离,预测前方路段相对所述移动机器人当前所在路面的倾斜角度,包括:
获取所述激光雷达发射的第一光束和第二光束在第一位置测得的距离当前路面的第一固定距离和第二固定距离;
获取所述激光雷达发射的第一光束和第二光束在第二位置测得的距离前方路段的第一测量距离和第二测量距离;
根据所述第一固定距离、所述第二固定距离、所述第一测量距离、所述第二测量距离和光束夹角,计算所述前方路段相对当前路面的倾斜角度,所述光束夹角是所述第一光束与所述第二光束之间的夹角。
4.根据权利要求1所述的方法,其特征在于,所述坡度阈值包括最大上坡角度和最小下坡角度,所述根据所述坡度、所述坡度与所述移动机器人的坡度阈值的比较结果,控制所述移动机器人运动,包括:
根据所述坡度的正负情况,确定所述前方路段的上下坡情况,所述上下坡情况为上坡路段或下坡路段;
若所述前方路段为上坡路段,则确定所述坡度是否小于所述最大上坡角度;
若所述坡度小于所述最大上坡角度,则控制所述移动机器人上坡。
5.根据权利要求4所述的方法,其特征在于,所述控制所述移动机器人上坡,包括:
确定所述坡度与所述俯仰角度的大小关系,所述大小关系为大于、小于或等于;
若所述坡度大于所述俯仰角度,则增大所述移动机器人的牵引力;
若所述坡度小于所述俯仰角度,则增大所述移动机器人的速度;
若所述坡度等于所述俯仰角度,则保持所述移动机器人的牵引力和速度不变。
6.根据权利要求4所述的方法,其特征在于,所述方法还包括:
若所述前方路段为下坡路段,则确定所述坡度是否大于所述最小下坡角度;
若所述坡度大于所述最小下坡角度,则控制所述移动机器人下坡。
7.根据权利要求1-6任一项所述的方法,其特征在于,所述方法还包括:
对所述激光雷达的测量距离大于距离阈值的数据进行去除,并对测量距离进行拟合获得所述距离信息。
8.根据权利要求1-6任一项所述的方法,其特征在于,所述爬坡警示信息包括语音提醒或灯光提醒。
9.根据权利要求1-6任一项所述的方法,其特征在于,所述方法还包括:
当所述移动机器人经过所述坡度区域时,若基于所述倾斜角度和所述俯仰角度,确定前方路段无坡度,则将该坡度区域进行更新。
10.一种移动机器人的控制装置,其特征在于,包括:
坡度预测模块,用于当激光雷达获得的距离信息发生有效距离变化时,根据所述激光雷达在第一位置测得的距离当前路面的固定距离和在第二位置测得的距离前方路段的测量距离,预测前方路段相对所述移动机器人当前所在路面的倾斜角度;基于所述倾斜角度和惯性测量单元测得的俯仰角度,确定前方路段的坡度;
运动控制模块,用于根据所述坡度、所述坡度与所述移动机器人的坡度阈值的比较结果,控制所述移动机器人运动;将所述前方路段在坡度地图上标记为坡度区域,所述坡度地图用于当所述移动机器人经过所述坡度区域,根据所述坡度区域,控制所述移动机器人发出爬坡警示信息。
11.一种移动机器人,其特征在于,包括:
激光雷达,用于测量所述激光雷达距离路面的距离;
惯性测量单元,用于测量所述移动机器人当前的俯仰角度;
数据处理中心,包括:存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现如权利要求1-9中任一项所述的移动机器人的控制方法。
12.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1-9中任一项所述的移动机器人的控制方法。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110670350.9A CN113433939B (zh) | 2021-03-11 | 2021-03-11 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
CN202110263046.2A CN112684803B (zh) | 2021-03-11 | 2021-03-11 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
JP2022542764A JP7326630B2 (ja) | 2021-03-11 | 2022-01-10 | 移動ロボットの制御方法、装置、移動ロボット及び記憶媒体 |
PCT/CN2022/071028 WO2022188539A1 (zh) | 2021-03-11 | 2022-01-10 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
US17/879,068 US11619948B2 (en) | 2021-03-11 | 2022-08-02 | Control method of mobile robot, mobile robot, and storage medium |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110263046.2A CN112684803B (zh) | 2021-03-11 | 2021-03-11 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110670350.9A Division CN113433939B (zh) | 2021-03-11 | 2021-03-11 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112684803A true CN112684803A (zh) | 2021-04-20 |
CN112684803B CN112684803B (zh) | 2021-06-11 |
Family
ID=75458378
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110670350.9A Active CN113433939B (zh) | 2021-03-11 | 2021-03-11 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
CN202110263046.2A Active CN112684803B (zh) | 2021-03-11 | 2021-03-11 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
Family Applications Before (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110670350.9A Active CN113433939B (zh) | 2021-03-11 | 2021-03-11 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
Country Status (4)
Country | Link |
---|---|
US (1) | US11619948B2 (zh) |
JP (1) | JP7326630B2 (zh) |
CN (2) | CN113433939B (zh) |
WO (1) | WO2022188539A1 (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113110475A (zh) * | 2021-04-26 | 2021-07-13 | 上海景吾智能科技有限公司 | 一种机器人平稳上下坡导航的方法及系统 |
CN113246126A (zh) * | 2021-04-30 | 2021-08-13 | 上海擎朗智能科技有限公司 | 机器人移动控制方法、机器人移动控制装置及机器人 |
CN113778086A (zh) * | 2021-09-03 | 2021-12-10 | 上海擎朗智能科技有限公司 | 地图构建和使用方法、机器人及存储介质 |
CN114942427A (zh) * | 2022-05-13 | 2022-08-26 | 济南大学 | 一种工程机械无人施工的地形识别方法、系统和机械设备 |
WO2022188539A1 (zh) * | 2021-03-11 | 2022-09-15 | 上海擎朗智能科技有限公司 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024088506A1 (en) * | 2022-10-24 | 2024-05-02 | Volvo Truck Corporation | Slope estimation using ground radar |
CN115598635B (zh) * | 2022-12-15 | 2023-04-07 | 江苏索利得物联网有限公司 | 一种基于北斗定位的毫米波雷达测距融合方法及系统 |
CN117968665B (zh) * | 2024-03-28 | 2024-07-26 | 杭州计算机外部设备研究所(中国电子科技集团公司第五十二研究所) | 一种目标融合方法及系统 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1800780A (zh) * | 2004-12-31 | 2006-07-12 | 比亚迪股份有限公司 | 车载道路坡度角测量系统及车载道路坡度角测量方法 |
CN103837139A (zh) * | 2012-11-23 | 2014-06-04 | 株式会社日立制作所 | 不平路面驾驶辅助设备和用于不平路面驾驶辅助的方法 |
JP5775632B2 (ja) * | 2014-09-16 | 2015-09-09 | 株式会社トプコン | 飛行体の飛行制御システム |
CN104950313A (zh) * | 2015-06-11 | 2015-09-30 | 同济大学 | 一种路面提取及道路坡度识别方法 |
CN106338285A (zh) * | 2016-08-11 | 2017-01-18 | 深圳乐行天下科技有限公司 | 一种行进辅助方法、系统及机器人 |
CN106646508A (zh) * | 2016-11-24 | 2017-05-10 | 中国科学院自动化研究所 | 面向斜坡区域的基于多线激光雷达的斜坡角度估计方法 |
US20190001978A1 (en) * | 2017-06-29 | 2019-01-03 | Denso Corporation | Vehicle control method and apparatus |
CN109387855A (zh) * | 2018-10-29 | 2019-02-26 | 浙江大学 | 一种利用车载脉冲激光雷达提前预测坡道坡度及坡长的系统 |
CN109540162A (zh) * | 2018-11-12 | 2019-03-29 | 北京四维图新科技股份有限公司 | Adas地图数据的处理方法、获取方法、装置及车载设备 |
CN111458722A (zh) * | 2020-04-16 | 2020-07-28 | 杭州师范大学钱江学院 | 一种激光雷达小车在具有坡度环境下的地图构建方法 |
Family Cites Families (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5714928A (en) * | 1992-12-18 | 1998-02-03 | Kabushiki Kaisha Komatsu Seisakusho | System for preventing collision for vehicle |
JPH07113866A (ja) * | 1993-10-14 | 1995-05-02 | Hino Motors Ltd | 車両の坂道への接触を検出する装置 |
JP2006300588A (ja) * | 2005-04-18 | 2006-11-02 | Sumitomo Electric Ind Ltd | 車両用傾斜角検出装置 |
JP2006276023A (ja) * | 2006-04-05 | 2006-10-12 | Omron Corp | 対象物検出装置および方法 |
US7970512B2 (en) * | 2006-08-30 | 2011-06-28 | Ford Global Technologies | Integrated control system for stability control of yaw, roll and lateral motion of a driving vehicle using an integrated sensing system with pitch information |
JP2010127846A (ja) * | 2008-11-28 | 2010-06-10 | Toyota Motor Corp | レーザレーダ制御装置 |
JP2011106877A (ja) * | 2009-11-13 | 2011-06-02 | Toyota Motor Corp | 道路勾配推定装置 |
JP5267592B2 (ja) * | 2010-04-09 | 2013-08-21 | 株式会社デンソー | 物体認識装置 |
JP2011232230A (ja) * | 2010-04-28 | 2011-11-17 | Denso Corp | 上方障害物検知装置、衝突防止装置および上方障害物検知方法 |
JP2012225806A (ja) * | 2011-04-20 | 2012-11-15 | Toyota Central R&D Labs Inc | 道路勾配推定装置及びプログラム |
CN102252659B (zh) * | 2011-06-10 | 2013-03-27 | 中国汽车工程研究院股份有限公司 | 基于激光传感器的车载式道路路面坡度测量方法 |
DE102012200048A1 (de) * | 2012-01-03 | 2013-07-04 | Robert Bosch Gmbh | Verfahren und Steuergerät zum Anpassen einer oberen Scheinwerferstrahlgrenze eines Scheinwerferkegels |
JP2017211758A (ja) * | 2016-05-24 | 2017-11-30 | シャープ株式会社 | 自律走行装置 |
JP6816389B2 (ja) * | 2016-06-30 | 2021-01-20 | アイシン精機株式会社 | 周辺監視装置 |
WO2019107550A1 (ja) * | 2017-12-01 | 2019-06-06 | パイオニア株式会社 | 制御装置、検知装置、制御方法、プログラム及び記憶媒体 |
JP2019100856A (ja) * | 2017-12-01 | 2019-06-24 | パイオニア株式会社 | 制御装置、検知装置、制御方法、プログラム及び記憶媒体 |
CN109848997B (zh) * | 2019-03-20 | 2020-08-04 | 杭州晶一智能科技有限公司 | 基于下倾立体相机的移动机器人前方坡度快速预测方法 |
CN110044333A (zh) * | 2019-05-14 | 2019-07-23 | 芜湖汽车前瞻技术研究院有限公司 | 一种基于单目视觉的坡度检测方法和装置 |
CN113433939B (zh) * | 2021-03-11 | 2024-04-12 | 上海擎朗智能科技有限公司 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
-
2021
- 2021-03-11 CN CN202110670350.9A patent/CN113433939B/zh active Active
- 2021-03-11 CN CN202110263046.2A patent/CN112684803B/zh active Active
-
2022
- 2022-01-10 JP JP2022542764A patent/JP7326630B2/ja active Active
- 2022-01-10 WO PCT/CN2022/071028 patent/WO2022188539A1/zh active Application Filing
- 2022-08-02 US US17/879,068 patent/US11619948B2/en active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1800780A (zh) * | 2004-12-31 | 2006-07-12 | 比亚迪股份有限公司 | 车载道路坡度角测量系统及车载道路坡度角测量方法 |
CN103837139A (zh) * | 2012-11-23 | 2014-06-04 | 株式会社日立制作所 | 不平路面驾驶辅助设备和用于不平路面驾驶辅助的方法 |
JP5775632B2 (ja) * | 2014-09-16 | 2015-09-09 | 株式会社トプコン | 飛行体の飛行制御システム |
CN104950313A (zh) * | 2015-06-11 | 2015-09-30 | 同济大学 | 一种路面提取及道路坡度识别方法 |
CN106338285A (zh) * | 2016-08-11 | 2017-01-18 | 深圳乐行天下科技有限公司 | 一种行进辅助方法、系统及机器人 |
CN106646508A (zh) * | 2016-11-24 | 2017-05-10 | 中国科学院自动化研究所 | 面向斜坡区域的基于多线激光雷达的斜坡角度估计方法 |
US20190001978A1 (en) * | 2017-06-29 | 2019-01-03 | Denso Corporation | Vehicle control method and apparatus |
CN109387855A (zh) * | 2018-10-29 | 2019-02-26 | 浙江大学 | 一种利用车载脉冲激光雷达提前预测坡道坡度及坡长的系统 |
CN109540162A (zh) * | 2018-11-12 | 2019-03-29 | 北京四维图新科技股份有限公司 | Adas地图数据的处理方法、获取方法、装置及车载设备 |
CN111458722A (zh) * | 2020-04-16 | 2020-07-28 | 杭州师范大学钱江学院 | 一种激光雷达小车在具有坡度环境下的地图构建方法 |
Non-Patent Citations (2)
Title |
---|
JENNIFER DAVID等: "Gradient based Path Optimization method for Autonomous Driving", 《2017 IEEE/RSJ INTERNATIONAL CONFERENCE ON INTELLIGENT ROBOTS AND SYSTEMS (IROS)》 * |
辛菁等: "基于迁移学习的移动机器人单帧图像坡度检测算法", 《智能系统学报》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022188539A1 (zh) * | 2021-03-11 | 2022-09-15 | 上海擎朗智能科技有限公司 | 移动机器人的控制方法、装置、移动机器人和存储介质 |
US11619948B2 (en) | 2021-03-11 | 2023-04-04 | Keenon Robotics Co., Ltd. | Control method of mobile robot, mobile robot, and storage medium |
CN113110475A (zh) * | 2021-04-26 | 2021-07-13 | 上海景吾智能科技有限公司 | 一种机器人平稳上下坡导航的方法及系统 |
CN113246126A (zh) * | 2021-04-30 | 2021-08-13 | 上海擎朗智能科技有限公司 | 机器人移动控制方法、机器人移动控制装置及机器人 |
CN113246126B (zh) * | 2021-04-30 | 2023-02-03 | 上海擎朗智能科技有限公司 | 机器人移动控制方法、机器人移动控制装置及机器人 |
CN113778086A (zh) * | 2021-09-03 | 2021-12-10 | 上海擎朗智能科技有限公司 | 地图构建和使用方法、机器人及存储介质 |
CN113778086B (zh) * | 2021-09-03 | 2024-06-18 | 上海擎朗智能科技有限公司 | 地图构建和使用方法、机器人及存储介质 |
CN114942427A (zh) * | 2022-05-13 | 2022-08-26 | 济南大学 | 一种工程机械无人施工的地形识别方法、系统和机械设备 |
CN114942427B (zh) * | 2022-05-13 | 2024-06-11 | 济南大学 | 一种工程机械无人施工的地形识别方法、系统和机械设备 |
Also Published As
Publication number | Publication date |
---|---|
US11619948B2 (en) | 2023-04-04 |
CN112684803B (zh) | 2021-06-11 |
CN113433939B (zh) | 2024-04-12 |
US20220374014A1 (en) | 2022-11-24 |
JP2023516110A (ja) | 2023-04-18 |
JP7326630B2 (ja) | 2023-08-15 |
CN113433939A (zh) | 2021-09-24 |
WO2022188539A1 (zh) | 2022-09-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112684803B (zh) | 移动机器人的控制方法、装置、移动机器人和存储介质 | |
JP4980076B2 (ja) | 車両の運転支援装置 | |
JP6477882B2 (ja) | 自己位置推定装置及び自己位置推定方法 | |
JP6256611B2 (ja) | 信号機検出装置及び信号機検出方法 | |
RU2770230C1 (ru) | Способ и устройство для предсказания движения другого транспортного средства | |
JP6511938B2 (ja) | 走行制御システム | |
JP2022009988A (ja) | 制御装置 | |
US10325163B2 (en) | Vehicle vision | |
US11353878B2 (en) | Soft-boundary based path optimization for complex scenes for autonomous driving vehicles | |
JP2007251257A (ja) | 画像認識装置、車両制御装置、画像認識方法および車両制御方法 | |
JP6744367B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
JPWO2018066133A1 (ja) | 車両判定方法、走行経路補正方法、車両判定装置、及び走行経路補正装置 | |
JP2022048339A (ja) | 情報処理装置 | |
JP2019107971A (ja) | 車両制御装置、方法およびプログラム | |
JP2011203795A (ja) | 走行支援装置 | |
JP2018092256A (ja) | 死角カバレッジ装置、制御装置、移動体の分散制御プログラム | |
JP2019152575A (ja) | 物体追跡装置、物体追跡方法及び物体追跡用コンピュータプログラム | |
JP2012141740A (ja) | 車両用外界認識装置およびそれを用いた車両システム | |
JP2020069969A (ja) | 車両制御システム | |
JP7167732B2 (ja) | 地図情報システム | |
JP2020086489A (ja) | 白線位置推定装置及び白線位置推定方法 | |
CN112660155B (zh) | 车辆控制系统 | |
CN110347166B (zh) | 用于自动驾驶系统的传感器控制方法 | |
JP2015130069A (ja) | 運転支援装置 | |
CN110427035B (zh) | 用于车辆的目标追踪方法 |
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 |