CN114152255A - 智能移动机器人定位、导航的控制方法 - Google Patents
智能移动机器人定位、导航的控制方法 Download PDFInfo
- Publication number
- CN114152255A CN114152255A CN202010933985.9A CN202010933985A CN114152255A CN 114152255 A CN114152255 A CN 114152255A CN 202010933985 A CN202010933985 A CN 202010933985A CN 114152255 A CN114152255 A CN 114152255A
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- intelligent mobile
- positioning
- navigation
- identification
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000009286 beneficial effect Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 3
- 238000013519 translation Methods 0.000 description 3
- 238000011161 development Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及移动机器人技术领域,尤其涉及一种智能移动机器人定位、导航的控制方法,包括如下步骤:步骤S1:存储地图信息;步骤S2:存储用于定位、导航的标识图案,及标识图案所代表的路径信息;步骤S3:识别标识图案;步骤S4:根据标识图案进行路径规划。本发明的智能移动机器人定位、导航的控制方法可较准确地确定目前基于地图中的位置,同时可通过标识图案确定出路径规划,有利于实现智能移动机器人持续执行任务,降低停止工作或走错目的点的可能性。
Description
【技术领域】
本发明涉及移动机器人技术领域,尤其涉及一种智能移动机器人定位、导航的控制方法。
【背景技术】
随着科技的发展及人工视觉领域的发展,研发人员将工作重点转移至机器人领域上,以替代部分人的工作,降低人的劳动量。
市面上大多数机器人无法辨别自身所处在地图中的具***置,导致无法准确地确定出下一目标位置的具体方位,导致机器人因没有目标而停止工作或走错目的地。
因此,现有技术存在不足,需要改进。
【发明内容】
为克服上述的技术问题,本发明提供了一种智能移动机器人定位、导航的控制方法。
本发明解决技术问题的方案是提供一种智能移动机器人定位、导航的控制方法,包括如下步骤:
步骤S1:存储地图信息;
步骤S2:存储用于定位、导航的标识图案,及标识图案所代表的地标信息;
步骤S3:识别标识图案;
步骤S4:根据标识图案进行路径规划。
优选地,所述地图信息包括用于智能移动机器人移动的地图、位于地图上的障碍物的位置及标识图案的位置。
优选地,所述标识图案包括用于确认机器人与标识图案之间的相对位置和姿态的定位信息及用于确认目前标识图案所处地图信息中的坐标的辨认信息,所述定位信息围设在辨认信息外且包括至少四条边。
优选地,步骤S3还包括如下步骤:
步骤S31:检测到标识图案;
步骤S32:提取定位信息至少4个关键点;
步骤S33:结合实际参数并利用求解PnP的方法,求解出智能移动机器人相对于图案的6自由度位姿信息;
步骤S34:根据辨认信息,确定出当前标识图案所处地图信息中的位置;
步骤S35:结合地图信息,确定出智能移动机器人所处的位置及当前的姿态。
优选地,所述实际参数包括摄像头的参数、标识图案的实际尺寸及摄像头在机器人上所处的位置。
优选地,所述步骤S4还包括如下步骤:
步骤S41:建立坐标系并以当前智能移动机器人所处的位置为原点;
步骤S42:计算出智能移动机器人下一目标位置的坐标点(xP,yP)及智能移动机器人在下一目标位置时所需要旋转的角度θ;
步骤S43:计算出智能移动机器人在旋转角度θ后需要进行左右平移的dx,控制智能移动机器人旋转角度θ的同时在左右方向平移dx的长度;
步骤S44:计算出智能移动机器人在旋转角度θ及在左右方向平移dx长度后与下一目标位置的距离dy,控制智能移动机器人在进行步骤S43后朝向下一目标位置移动距离dy。
优选地,所述智能移动机器人定位、导航的控制方法还包括如下步骤:
步骤S5:通过位置环输出车身的目标速度,通过车身的目标速度分解为电机的目标速度;
步骤S6:通过速度环控制输出电机的PWM值。
优选地,通过IMU惯性传感器实现智能移动机器人旋转角度θ。
优选地,在步骤S31中,通过摄像头对标识图案进行检测。
相对于现有技术,本发明的智能移动机器人定位、导航的控制方法具有如下优点:
通过存储地图信息以及标识图案,智能移动机器人在地图上获取标识图案时便可根据与所检测到的标识图案来确定自身所处的位置进而确定在地图中的位置,因此可根据存储的地图信息前往下一目标点,而不至于因无法确定其所在地图中的位置导致走错或停止工作的情况的产生。
【附图说明】
图1是本发明智能移动机器人定位、导航的控制方法的步骤S1-4的具体流程结构示意图。
图2是本发明智能移动机器人定位、导航的控制方法的步骤S3的具体流程结构示意图。
图3是本发明智能移动机器人定位、导航的控制方法的步骤S4的具体流程结构示意图。
图4是本发明智能移动机器人定位、导航的控制方法的步骤S5-6的具体流程结构示意图。
【具体实施方式】
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施实例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用于解释本发明,并不用于限定本发明。
请参阅图1-图4,本发明提供一种智能移动机器人定位、导航的控制方法,包括如下步骤:
步骤S1:存储地图信息;
步骤S2:存储用于定位、导航的标识图案,及标识图案所代表的地标信息。
具体地,地图信息包括地图、位于地图上的障碍物的位置及标识图案的位置。其中地图用于智能移动机器人的移动,其可以为模块化的沙盘地图。
进一步地,标识图案包括定位信息及辨认信息,定位信息围设在辨认信息外且包括至少四条边。定位信息用于确认机器人与标识图案之间的相对位置及姿态,辨认信息用于确认目前标识图案在地图中的坐标,其中智能移动机器人的姿态为其识别标识图案的传感器与标识图案的角度。优选地,标识图案为二维码、AprilTag等。
步骤S3:识别标识图案。
智能移动机器人在地图上移动时通过对标识图案进行识别以确定自身所处地图中的位置,进而可对下一行进目的地做路径规划,以防智能移动机器人无目标行走,扰乱工作进程。
进一步地,步骤S3还包括如下步骤:
步骤S31:检测到标识图案;
步骤S32:提取定位信息至少4个关键点;
步骤S33:结合实际参数并利用求解PnP的方法,求解出智能移动机器人相对于图案的6自由度位姿信息;
步骤S34:根据辨认信息,确定出当前标识图案所处地图信息中的位置;
步骤S35:结合地图信息,确定出智能移动机器人所处的位置及当前的姿态。
由于定位信息包括至少四条边,因此可提取定位信息相邻边框的交点作为识别特征,并结合步骤S33确定出智能移动机器人与所检测的标识图案的相对位置及姿态;随后对辨认信息进行识别,以确定处当前所检测的标识图案在地图中的位置,结合对标识图案的定位信息及辨认信息进行识别,便可确定出智能移动机器人在地图中的位置及姿态,以便后续对自身的状态进行调整前往下一目标地点。
可以理解,在步骤S31中,在本发明中,智能移动机器人采用摄像头对标识图案进行检测;作为一种可选方案,还可通过超声波传感器、红外传感器等对地图中的边界信息、地面标记信息等进行检测,以更准确地确定所处地图中的位置。
在步骤S33中,实际参数包括摄像头的参数、标识图案的实际尺寸及摄像头在智能移动机器人上所处的位置,通过将实际参数加进计算中,增加了智能移动机器人相对标识图案位姿信息的精确程度。
步骤S4:根据标识图案进行路径规划。
进一步地,步骤S4还包括如下步骤:
步骤S41:建立坐标系并以当前智能移动机器人所处的位置为原点;
步骤S42:计算出智能移动机器人下一目标位置的坐标点(xP,yP)及智能移动机器人在下一目标位置时所需要旋转的角度θ;
步骤S43:计算出智能移动机器人在旋转角度θ后需要进行左右平移的dx,控制智能移动机器人旋转角度θ的同时在左右方向平移dx的长度;
步骤S44:计算出智能移动机器人在旋转角度θ及在左右方向平移dx长度后与下一目标位置的距离dy,控制智能移动机器人在进行步骤S43后朝向下一目标位置移动距离dy。
本发明的智能移动机器人从检测到标识图案时所处的位置通过旋转角度θ的同时在左右方向平移dx的长度,此时智能移动机器人朝向的方向与下一目标位置时的朝向的方向一致,此时智能移动机器人仅需在旋转角度θ后的朝向方向在前后方向移动dy的距离即可实现到达下一目标且满足预设的朝向方向与位于下一目标处时的朝向方向一致。
可以理解,本发明的朝向方向为位于智能移动机器人上的摄像头所拍摄的方向,可认定为正前方,其中在左右方向平移及前后方向运动均基于该正前方而设定;在旋转角度θ的同时在左右方向进行平移而不是先进行旋转后再进行左右方向的平移,如此,可降低在旋转、左右移动过程中摄像头丢失视野的可能性,有利于降低智能移动机器人丢失目标的概率。
在本发明中,智能移动机器人通过IMU惯性传感器实现角度θ的旋转。
优选地,本发明的智能移动机器人定位、导航的控制方法还包括如下步骤:
步骤S5:通过位置环输出车身的目标速度,通过车身的目标速度分解为电机的目标速度;
即在路径规划后通过位置环及速度环的控制实现智能移动机器人的运动,通过位置环确定车身的得位置并输出车身到达目标位置所需要的目标速度,并通过车身的目标速度分解成电机的目标速度;在进行电机测速度,采用未设置方向的光栅编码器,通过发送给电机PWM值来确定电机的旋转方向。
步骤S6:通过速度环控制输出电机的PWM值。
在步骤S5之后,需对智能移动机器人的电机进行测速,可采用至少两编码器分别与电机两两安装,其他未安装有编码器的电机可通过陀螺仪对车身的旋转进行测量并结合已安装编码器电机的速度,推算出旋转速度;在速度测量完成后速度环进行控制,累加电机在仅左右平移、前后平移及旋转时的PWM值并作为最终PWM输出值,以实现智能移动机器人朝向下一目标位置的移动。
相对于现有技术,本发明的智能移动机器人定位、导航的控制方法具有如下优点:
通过存储地图信息以及标识图案,智能移动机器人在地图上获取标识图案时便可根据与所检测到的标识图案来确定自身所处的位置进而确定在地图中的位置,因此可根据存储的地图信息前往下一目标点,而不至于因无法确定其所在地图中的位置导致走错或停止工作的情况的产生。
以上所述仅为本发明的较佳实施例,并非因此限制本发明的专利范围,凡是在本发明的构思之内所作的任何修改,等同替换和改进等均应包含在本发明的专利保护范围内。
Claims (10)
1.一种智能移动机器人定位、导航的控制方法,其特征在于:所述智能移动机器人定位、导航的控制方法包括如下步骤:
步骤S1:存储地图信息;
步骤S2:存储用于定位、导航的标识图案,及标识图案所代表的地标信息;
步骤S3:识别标识图案;
步骤S4:根据标识图案进行路径规划。
2.如权利要求1所述的智能移动机器人定位、导航的控制方法,其特征在于:所述地图信息包括用于智能移动机器人移动的地图、位于地图上的障碍物的位置及标识图案的位置。
3.如权利要求1所述的智能移动机器人定位、导航的控制方法,其特征在于:所述标识图案包括用于确认机器人与标识图案之间的相对位置和姿态的定位信息及用于确认目前标识图案所处地图信息中的坐标的辨认信息,所述定位信息围设在辨认信息外且包括至少四条边。
4.如权利要求3所述的智能移动机器人定位、导航的控制方法,其特征在于:步骤S3还包括如下步骤:
步骤S31:检测到标识图案;
步骤S32:提取定位信息至少4个关键点;
步骤S33:结合实际参数并利用求解PnP的方法,求解出智能移动机器人相对于图案的6自由度位姿信息;
步骤S34:根据辨认信息,确定出当前标识图案所处地图信息中的位置;
步骤S35:结合地图信息,确定出智能移动机器人所处的位置及当前的姿态。
5.如权利要求4所述的智能移动机器人定位、导航的控制方法,其特征在于:所述实际参数包括摄像头的参数、标识图案的实际尺寸及摄像头在机器人上所处的位置。
6.如权利要求1所述的智能移动机器人定位、导航的控制方法,其特征在于:所述步骤S4还包括如下步骤:
步骤S41:建立坐标系并以当前智能移动机器人所处的位置为原点;
步骤S42:计算出智能移动机器人下一目标位置的坐标点(xP,yP)及智能移动机器人在下一目标位置时所需要旋转的角度θ;
步骤S43:计算出智能移动机器人在旋转角度θ后需要进行左右平移的dx,控制智能移动机器人旋转角度θ的同时在左右方向平移dx的长度;
步骤S44:计算出智能移动机器人在旋转角度θ及在左右方向平移dx长度后与下一目标位置的距离dy,控制智能移动机器人在进行步骤S43后朝向下一目标位置移动距离dy。
8.如权利要求1所述的智能移动机器人定位、导航的控制方法,其特征在于:所述智能移动机器人定位、导航的控制方法还包括如下步骤:
步骤S5:通过位置环输出车身的目标速度,通过车身的目标速度分解为电机的目标速度;
步骤S6:通过速度环控制输出电机的PWM值。
9.如权利要求6所述的智能移动机器人定位、导航的控制方法,其特征在于:通过IMU惯性传感器实现智能移动机器人旋转角度θ。
10.如权利要求4所述的智能移动机器人定位、导航的控制方法,其特征在于:在步骤S31中,通过摄像头对标识图案进行检测。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010933985.9A CN114152255A (zh) | 2020-09-08 | 2020-09-08 | 智能移动机器人定位、导航的控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010933985.9A CN114152255A (zh) | 2020-09-08 | 2020-09-08 | 智能移动机器人定位、导航的控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114152255A true CN114152255A (zh) | 2022-03-08 |
Family
ID=80460675
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010933985.9A Pending CN114152255A (zh) | 2020-09-08 | 2020-09-08 | 智能移动机器人定位、导航的控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114152255A (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106969766A (zh) * | 2017-03-21 | 2017-07-21 | 北京品创智能科技有限公司 | 一种基于单目视觉和二维码路标的室内自主导航方法 |
CN107246868A (zh) * | 2017-07-26 | 2017-10-13 | 上海舵敏智能科技有限公司 | 一种协同导航定位***及导航定位方法 |
CN107450540A (zh) * | 2017-08-04 | 2017-12-08 | 山东大学 | 基于红外路标的室内移动机器人导航***及方法 |
CN107689061A (zh) * | 2017-07-11 | 2018-02-13 | 西北工业大学 | 用于室内移动机器人定位的规则图形码及定位方法 |
CN109754046A (zh) * | 2019-01-31 | 2019-05-14 | 北京迈格威科技有限公司 | 二维码、二维码的编码方法、解码方法、装置及设备 |
CN110487283A (zh) * | 2019-09-17 | 2019-11-22 | 国微集团(深圳)有限公司 | 可识别的码点块以及基于该码点块的导航方法及*** |
US20190375103A1 (en) * | 2018-06-08 | 2019-12-12 | Ankobot (Shenzhen) Smart Technologies Co., Ltd. | Navigation method, navigation system, movement control system and mobile robot |
CN110673612A (zh) * | 2019-10-21 | 2020-01-10 | 重庆邮电大学 | 一种自主移动机器人二维码引导控制方法 |
-
2020
- 2020-09-08 CN CN202010933985.9A patent/CN114152255A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106969766A (zh) * | 2017-03-21 | 2017-07-21 | 北京品创智能科技有限公司 | 一种基于单目视觉和二维码路标的室内自主导航方法 |
CN107689061A (zh) * | 2017-07-11 | 2018-02-13 | 西北工业大学 | 用于室内移动机器人定位的规则图形码及定位方法 |
CN107246868A (zh) * | 2017-07-26 | 2017-10-13 | 上海舵敏智能科技有限公司 | 一种协同导航定位***及导航定位方法 |
CN107450540A (zh) * | 2017-08-04 | 2017-12-08 | 山东大学 | 基于红外路标的室内移动机器人导航***及方法 |
US20190375103A1 (en) * | 2018-06-08 | 2019-12-12 | Ankobot (Shenzhen) Smart Technologies Co., Ltd. | Navigation method, navigation system, movement control system and mobile robot |
CN109754046A (zh) * | 2019-01-31 | 2019-05-14 | 北京迈格威科技有限公司 | 二维码、二维码的编码方法、解码方法、装置及设备 |
CN110487283A (zh) * | 2019-09-17 | 2019-11-22 | 国微集团(深圳)有限公司 | 可识别的码点块以及基于该码点块的导航方法及*** |
CN110673612A (zh) * | 2019-10-21 | 2020-01-10 | 重庆邮电大学 | 一种自主移动机器人二维码引导控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zhang et al. | Localization and navigation using QR code for mobile robot in indoor environment | |
CN111055281B (zh) | 一种基于ros的自主移动抓取***与方法 | |
US7899618B2 (en) | Optical laser guidance system and method | |
CN112183133B (zh) | 一种基于ArUco码引导的移动机器人自主充电方法 | |
CN110673612A (zh) | 一种自主移动机器人二维码引导控制方法 | |
US10508923B2 (en) | Vehicle position estimation device, vehicle position estimation method | |
CN108226938A (zh) | 一种agv小车的定位***和方法 | |
CN106527432A (zh) | 基于模糊算法和二维码自矫正的室内移动机器人协作*** | |
CN112101128B (zh) | 一种基于多传感器信息融合的无人方程式赛车感知规划方法 | |
CN108345005A (zh) | 巷道掘进机的实时连续自主定位定向***及导航定位方法 | |
JP5310285B2 (ja) | 自己位置推定装置及び自己位置推定方法 | |
CN102520723A (zh) | 基于上悬无线传输摄像头的轮椅室内全局视频监控导航*** | |
CN110502010A (zh) | 一种基于贝塞尔曲线的移动机器人室内自主导航控制方法 | |
WO2019031168A1 (ja) | 移動体および移動体の制御方法 | |
CN108363395A (zh) | 一种agv自主避障的方法 | |
Kim et al. | Autonomous mobile robot localization and mapping for unknown construction environments | |
Rasmussen et al. | Perception and control strategies for driving utility vehicles with a humanoid robot | |
CN113610910B (zh) | 一种移动机器人避障方法 | |
JP2006252350A (ja) | 移動ロボット | |
CN107632607A (zh) | 基于二维激光Slam和Tag标签的移动机器人精确定位方法 | |
CN106325278A (zh) | 一种基于椭圆识别的机器人定位导航方法 | |
CN114152255A (zh) | 智能移动机器人定位、导航的控制方法 | |
CN107300872A (zh) | 一种基于视觉成像的定位导航装置及定位导航方法 | |
JP2003330538A (ja) | 自律移動ロボットおよびその自律移動方法 | |
WO2023050545A1 (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 |