CN108388242A - 机器人左右轮相对误差标定方法、装置及系统 - Google Patents
机器人左右轮相对误差标定方法、装置及系统 Download PDFInfo
- Publication number
- CN108388242A CN108388242A CN201810015598.XA CN201810015598A CN108388242A CN 108388242 A CN108388242 A CN 108388242A CN 201810015598 A CN201810015598 A CN 201810015598A CN 108388242 A CN108388242 A CN 108388242A
- Authority
- CN
- China
- Prior art keywords
- robot
- fence
- right wheels
- attitude angle
- relative error
- 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 15
- 238000012544 monitoring process Methods 0.000 claims abstract description 8
- 238000012937 correction Methods 0.000 claims description 6
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001681 protective effect Effects 0.000 description 1
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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明公开了机器人左右轮相对误差标定方法、装置及系统,设置两条相互平行的围栏,驶入机器人并控制机器人做直线运动,通过激光雷达监测机器人相对于围栏的姿态角变化,即可求取机器人实际运行弧线的半径,通过该半径可以获取机器人左右轮的比例误差,即左右轮的相对误差。本发明可以计算出机器人的左右轮相对误差,在后续运动过程中,纠正左右轮胎的比例误差就可以按照预设走直线路径。
Description
技术领域
本发明涉及机器人左右轮相对误差标定方法、装置及系统。
背景技术
移动机器人的左侧轮子和右侧轮子之间存在尺寸相对误差,会导致移动机器人走直行运动时偏向一方,因此需要标定该误差,从而针对该误差进行补偿。
发明内容
为了克服现有技术的不足,本发明的目的在于提供机器人左右轮相对误差标定方法、装置及系统,旨在解决现有技术的机器人左侧轮子和右侧轮子之间存在尺寸相对误差导致机器人直线运动时偏向一方的问题。
本发明的目的采用以下技术方案实现:
一种机器人左右轮相对误差标定方法,包括:
围栏设置步骤,设置两条相互平行的围栏,记为第一围栏和第二围栏;
第一姿态角获取步骤,在机器人驶入围栏之间后,通过安装在机器人顶部中间的激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第一姿态角a1;
直线运动步骤,控制机器人直线行走预定距离L;
第二姿态角获取步骤,在机器人运动结束后,通过激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第二姿态角a2;
弧线半径计算步骤,根据第一姿态角a1、第二姿态角a2和预定距离L,计算机器人的实际行走弧线的半径R:
左右轮相对误差计算步骤,根据半径R、车身宽度H车身和轮胎宽度H轮胎,计算机器人的左右轮相对误差
其中,H为半车身,
在上述实施例的基础上,优选的,还包括:
误差更正步骤:
多次重复第一姿态角获取步骤、第一姿态角获取步骤、直线运动步骤、第二姿态角获取步骤、弧线半径计算步骤和左右轮相对误差计算步骤,求取左右轮相对误差的平均值。
一种机器人左右轮相对误差标定装置,包括:
围栏设置模块,用于设置两条相互平行的围栏,记为第一围栏和第二围栏;
第一姿态角获取模块,用于在机器人驶入围栏之间后,通过安装在机器人顶部中间的激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第一姿态角a1;
直线运动模块,用于控制机器人直线行走预定距离L;
第二姿态角获取模块,用于在机器人运动结束后,通过激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第二姿态角a2;
弧线半径计算模块,用于根据第一姿态角a1、第二姿态角a2和预定距离L,计算机器人的实际行走弧线的半径R:
左右轮相对误差计算模块,用于根据半径R、车身宽度H车身和轮胎宽度H轮胎,计算机器人的左右轮相对误差
其中,H为半车身,
在上述实施例的基础上,优选的,还包括:
误差更正模块:
多次重复调用第一姿态角获取模块、第一姿态角获取模块、直线运动模块、第二姿态角获取模块、弧线半径计算模块和左右轮相对误差计算模块,求取左右轮相对误差的平均值。
一种机器人左右轮相对误差标定系统,包括:
上述任一项实施例中的机器人左右轮相对误差标定装置;
围栏,包括相互平行的第一围栏和第二围栏,用于提供标定场地;
激光雷达,安装在机器人顶部中间,用于扫描环境,监测围栏的2条平行线。
在上述实施例的基础上,优选的,还包括与激光雷达连接的散热装置,用于为激光雷达提供散热功能。
在上述任意实施例的基础上,优选的,还包括与激光雷达连接的太阳能电源装置,用于为激光雷达提供太阳能电源。
相比现有技术,本发明的有益效果在于:
本发明公开了机器人左右轮相对误差标定方法、装置及系统,设置两条相互平行的围栏,驶入机器人并控制机器人做直线运动,通过激光雷达监测机器人相对于围栏的姿态角变化,即可求取机器人实际运行弧线的半径,通过该半径可以获取机器人左右轮的比例误差,即左右轮的相对误差。本发明可以计算出机器人的左右轮相对误差,在后续运动过程中,纠正左右轮胎的比例误差就可以按照预设走直线路径。
附图说明
下面结合附图和实施例对本发明进一步说明。
图1a示出了本发明实施例提供的一种机器人直线运动前后的姿态示意图;
图1b示出了本发明实施例提供的一种机器人左右轮相对误差标定方法的流程示意图;
图2示出了本发明实施例提供的一种机器人左右轮相对误差标定装置的结构示意图;
图3示出了本发明实施例提供的一种机器人左右轮相对误差标定系统的结构示意图。
具体实施方式
下面,结合附图以及具体实施方式,对本发明做进一步描述,需要说明的是,在不相冲突的前提下,以下描述的各实施例之间或各技术特征之间可以任意组合形成新的实施例。
具体实施例一
如图1a和图1b所示,本发明实施例提供了一种机器人左右轮相对误差标定方法,包括:
围栏设置步骤S101,设置两条相互平行的围栏,记为第一围栏和第二围栏;
第一姿态角获取步骤S102,在机器人驶入围栏之间后,通过安装在机器人顶部中间的激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第一姿态角a1;
直线运动步骤S103,控制机器人直线行走预定距离L;
第二姿态角获取步骤S104,在机器人运动结束后,通过激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第二姿态角a2;
弧线半径计算步骤S105,根据第一姿态角a1、第二姿态角a2和预定距离L,计算机器人的实际行走弧线的半径R:
此时,角度a2和a1采用弧度制;
左右轮相对误差计算步骤S106,根据半径R、车身宽度H车身和轮胎宽度H轮胎,计算机器人的左右轮相对误差
其中,H为半车身,
本发明实施例设置两条相互平行的围栏,驶入机器人并控制机器人做直线运动,通过激光雷达监测机器人相对于围栏的姿态角变化,即可求取机器人实际运行弧线的半径,通过该半径可以获取机器人左右轮的比例误差,即左右轮的相对误差。本发明实施例可以计算出机器人的左右轮相对误差,在后续运动过程中,纠正左右轮胎的比例误差就可以按照预设走直线路径。
优选的,本方法还可以包括:误差更正步骤:多次重复第一姿态角获取步骤、第一姿态角获取步骤、直线运动步骤、第二姿态角获取步骤、弧线半径计算步骤和左右轮相对误差计算步骤,求取左右轮相对误差的平均值。
在上述的具体实施例一中,提供了机器人左右轮相对误差标定方法,与之相对应的,本申请还提供机器人左右轮相对误差标定装置。由于装置实施例基本相似于方法实施例,所以描述得比较简单,相关之处参见方法实施例的部分说明即可。下述描述的装置实施例仅仅是示意性的。
具体实施例二
如图2所示,本发明实施例提供了一种机器人左右轮相对误差标定装置,包括:
围栏设置模块201,用于设置两条相互平行的围栏,记为第一围栏和第二围栏;
第一姿态角获取模块202,用于在机器人驶入围栏之间后,通过安装在机器人顶部中间的激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第一姿态角a1;
直线运动模块203,用于控制机器人直线行走预定距离L;
第二姿态角获取模块204,用于在机器人运动结束后,通过激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第二姿态角a2;
弧线半径计算模块205,用于根据第一姿态角a1、第二姿态角a2和预定距离L,计算机器人的实际行走弧线的半径R:
左右轮相对误差计算模块206,用于根据半径R、车身宽度H车身和轮胎宽度H轮胎,计算机器人的左右轮相对误差
其中,H为半车身,
本发明实施例设置两条相互平行的围栏,驶入机器人并控制机器人做直线运动,通过激光雷达监测机器人相对于围栏的姿态角变化,即可求取机器人实际运行弧线的半径,通过该半径可以获取机器人左右轮的比例误差,即左右轮的相对误差。本发明实施例可以计算出机器人的左右轮相对误差,在后续运动过程中,纠正左右轮胎的比例误差就可以按照预设走直线路径。
优选的,本装置还可以包括:误差更正模块:多次重复调用第一姿态角获取模块、第一姿态角获取模块、直线运动模块、第二姿态角获取模块、弧线半径计算模块和左右轮相对误差计算模块,求取左右轮相对误差的平均值。
具体实施例三
如图3所示,本发明实施例提供了一种机器人左右轮相对误差标定系统,包括:
具体实施例二中的机器人左右轮相对误差标定装置301;
围栏302,包括相互平行的第一围栏和第二围栏,用于提供标定场地;
激光雷达303,安装在机器人顶部中间,用于扫描环境,监测围栏的2条平行线。
本发明实施例设置两条相互平行的围栏,驶入机器人并控制机器人做直线运动,通过激光雷达监测机器人相对于围栏的姿态角变化,即可求取机器人实际运行弧线的半径,通过该半径可以获取机器人左右轮的比例误差,即左右轮的相对误差。本发明实施例可以计算出机器人的左右轮相对误差,在后续运动过程中,纠正左右轮胎的比例误差就可以按照预设走直线路径。
本系统对机器人左右轮相对误差标定装置301不做限定,优选的,其可以为计算机或服务器。
优选的,本系统还可以包括与激光雷达303连接的散热装置,用于为激光雷达303提供散热功能,提高激光雷达的稳定性。
优选的,本系统还可以包括与激光雷达303连接的太阳能电源装置,用于为激光雷达303提供太阳能电源。太阳能电源是清洁能源,绿色环保无公害。
本发明从使用目的上,效能上,进步及新颖性等观点进行阐述,其具有的实用进步性,己符合专利法所强调的功能增进及使用要件,本发明以上的说明及附图,仅为本发明的较佳实施例而己,并非以此局限本发明,因此,凡一切与本发明构造,装置,待征等近似、雷同的,即凡依本发明专利申请范围所作的等同替换或修饰等,皆应属本发明的专利申请保护的范围之内。
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。尽管本发明已进行了一定程度的描述,明显地,在不脱离本发明的精神和范围的条件下,可进行各个条件的适当变化。可以理解,本发明不限于所述实施方案,而归于权利要求的范围,其包括所述每个因素的等同替换。对本领域的技术人员来说,可根据以上描述的技术方案以及构思,做出其它各种相应的改变以及形变,而所有的这些改变以及形变都应该属于本发明权利要求的保护范围之内。
Claims (7)
1.一种机器人左右轮相对误差标定方法,其特征在于,包括:
围栏设置步骤,设置两条相互平行的围栏,记为第一围栏和第二围栏;
第一姿态角获取步骤,在机器人驶入围栏之间后,通过安装在机器人顶部中间的激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第一姿态角a1;
直线运动步骤,控制机器人直线行走预定距离L;
第二姿态角获取步骤,在机器人运动结束后,通过激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第二姿态角a2;
弧线半径计算步骤,根据第一姿态角a1、第二姿态角a2和预定距离L,计算机器人的实际行走弧线的半径R:
左右轮相对误差计算步骤,根据半径R、车身宽度H车身和轮胎宽度H轮胎,计算机器人的左右轮相对误差
其中,H为半车身,
2.根据权利要求1所述的机器人左右轮相对误差标定方法,其特征在于,还包括:
误差更正步骤:
多次重复第一姿态角获取步骤、第一姿态角获取步骤、直线运动步骤、第二姿态角获取步骤、弧线半径计算步骤和左右轮相对误差计算步骤,求取左右轮相对误差的平均值。
3.一种机器人左右轮相对误差标定装置,其特征在于,包括:
围栏设置模块,用于设置两条相互平行的围栏,记为第一围栏和第二围栏;
第一姿态角获取模块,用于在机器人驶入围栏之间后,通过安装在机器人顶部中间的激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第一姿态角a1;
直线运动模块,用于控制机器人直线行走预定距离L;
第二姿态角获取模块,用于在机器人运动结束后,通过激光雷达扫描环境,监测围栏的2条平行线,获取机器人相对第一围栏的第二姿态角a2;
弧线半径计算模块,用于根据第一姿态角a1、第二姿态角a2和预定距离L,计算机器人的实际行走弧线的半径R:
左右轮相对误差计算模块,用于根据半径R、车身宽度H车身和轮胎宽度H轮胎,计算机器人的左右轮相对误差
其中,H为半车身,
4.根据权利要求3所述的机器人左右轮相对误差标定装置,其特征在于,还包括:
误差更正模块:
多次重复调用第一姿态角获取模块、第一姿态角获取模块、直线运动模块、第二姿态角获取模块、弧线半径计算模块和左右轮相对误差计算模块,求取左右轮相对误差的平均值。
5.一种机器人左右轮相对误差标定系统,其特征在于,包括:
权利要求3或4所述的机器人左右轮相对误差标定装置;
围栏,包括相互平行的第一围栏和第二围栏,用于提供标定场地;
激光雷达,安装在机器人顶部中间,用于扫描环境,监测围栏的2条平行线。
6.根据权利要求5所述的机器人左右轮相对误差标定系统,其特征在于,还包括与激光雷达连接的散热装置,用于为激光雷达提供散热功能。
7.根据权利要求5或6所述的机器人左右轮相对误差标定系统,其特征在于,还包括与激光雷达连接的太阳能电源装置,用于为激光雷达提供太阳能电源。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810015598.XA CN108388242B (zh) | 2018-01-08 | 2018-01-08 | 机器人左右轮相对误差标定方法、装置及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810015598.XA CN108388242B (zh) | 2018-01-08 | 2018-01-08 | 机器人左右轮相对误差标定方法、装置及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108388242A true CN108388242A (zh) | 2018-08-10 |
CN108388242B CN108388242B (zh) | 2021-05-18 |
Family
ID=63076009
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810015598.XA Active CN108388242B (zh) | 2018-01-08 | 2018-01-08 | 机器人左右轮相对误差标定方法、装置及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108388242B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109213158A (zh) * | 2018-08-30 | 2019-01-15 | 四川超影科技有限公司 | 基于智能巡检机器人的轮径矫正方法 |
CN111947660A (zh) * | 2020-07-15 | 2020-11-17 | 深圳拓邦股份有限公司 | 一种航向纠正方法以及装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20120025839A (ko) * | 2010-09-08 | 2012-03-16 | 고려대학교 산학협력단 | 2-륜 이동 로봇의 오도메트리 오차 보정 방법 |
CN105437261A (zh) * | 2016-01-04 | 2016-03-30 | 杭州亚美利嘉科技有限公司 | 机器人轮胎磨损预警方法及装置 |
CN106289327A (zh) * | 2016-11-08 | 2017-01-04 | 成都通甲优博科技有限责任公司 | 一种差分移动机器人里程计标定方法 |
CN106393104A (zh) * | 2016-08-25 | 2017-02-15 | 北京创想智控科技有限公司 | 一种移动机器人的行程校准方法 |
JP6109435B1 (ja) * | 2016-04-15 | 2017-04-05 | 三菱電機株式会社 | 搬送装置、搬送装置の速度制御方法及び搬送装置の制御プログラム |
CN107085430A (zh) * | 2017-05-24 | 2017-08-22 | 深圳优地科技有限公司 | 一种轮式机器人参数调校的优化方法、装置和系统 |
-
2018
- 2018-01-08 CN CN201810015598.XA patent/CN108388242B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20120025839A (ko) * | 2010-09-08 | 2012-03-16 | 고려대학교 산학협력단 | 2-륜 이동 로봇의 오도메트리 오차 보정 방법 |
CN105437261A (zh) * | 2016-01-04 | 2016-03-30 | 杭州亚美利嘉科技有限公司 | 机器人轮胎磨损预警方法及装置 |
JP6109435B1 (ja) * | 2016-04-15 | 2017-04-05 | 三菱電機株式会社 | 搬送装置、搬送装置の速度制御方法及び搬送装置の制御プログラム |
CN106393104A (zh) * | 2016-08-25 | 2017-02-15 | 北京创想智控科技有限公司 | 一种移动机器人的行程校准方法 |
CN106289327A (zh) * | 2016-11-08 | 2017-01-04 | 成都通甲优博科技有限责任公司 | 一种差分移动机器人里程计标定方法 |
CN107085430A (zh) * | 2017-05-24 | 2017-08-22 | 深圳优地科技有限公司 | 一种轮式机器人参数调校的优化方法、装置和系统 |
Non-Patent Citations (2)
Title |
---|
BORENSTEIN J,ET AL.: "Measurement and correction of systematic odometry errors in mobile robots", 《IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION》 * |
王卫华 等: "测程法系统误差的测量与校核", 《机器人》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109213158A (zh) * | 2018-08-30 | 2019-01-15 | 四川超影科技有限公司 | 基于智能巡检机器人的轮径矫正方法 |
CN111947660A (zh) * | 2020-07-15 | 2020-11-17 | 深圳拓邦股份有限公司 | 一种航向纠正方法以及装置 |
CN111947660B (zh) * | 2020-07-15 | 2024-03-29 | 深圳拓邦股份有限公司 | 一种航向纠正方法以及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN108388242B (zh) | 2021-05-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108388242A (zh) | 机器人左右轮相对误差标定方法、装置及系统 | |
EP3582055B1 (en) | Solar panel cleaning robot positioning device and positioning method thereof | |
CN110471429A (zh) | 基于改进人工势场法的割草机器人实时避障方法 | |
CN103175470B (zh) | 基于线结构光视觉传感器的基准球定位测量方法 | |
NZ603897A (en) | Omni-directional wheel assembly and omni-directional vehicle | |
WO2021030489A3 (en) | Compact energy conversion system | |
CN108326845A (zh) | 基于双目相机和激光雷达的机器人定位方法、装置及系统 | |
CN106142029A (zh) | 一种用于客车后桥装配的工装车 | |
CN110001998A (zh) | 一种基于激光测距的飞机大部件框式结构对接引导装置与方法 | |
CN106773514A (zh) | 一种摄像模组光轴平行调节方法及系统 | |
CN203951400U (zh) | 救护车太阳能供电装置 | |
CN104898551B (zh) | 全自动割草机器人的双视觉自定位系统 | |
CN206515541U (zh) | 特殊透镜角度及位移自动调节装置 | |
CN108334075A (zh) | 机器人轮胎绝对误差标定方法、装置及系统 | |
CN109131859A (zh) | 一种基于物联网的用于农业浇灌的新型无人机 | |
CN101218532A (zh) | 构造薄膜镜的方法 | |
CN207039061U (zh) | 自适应线路线况的巡检机器人柔性动力机构和巡检机器人 | |
CN205557422U (zh) | 一种建筑工地便捷洒水车 | |
CN115202371B (zh) | 平板清扫机器人的运动控制方法及相关装置 | |
CN208774647U (zh) | 车辆后视镜和车辆 | |
CN109298715A (zh) | 机器人行进控制系统及行进控制方法 | |
CN108265691A (zh) | 一种小河道浮萍打捞小车 | |
CN205440852U (zh) | 一种用于指挥车的无人机降落底座 | |
CN207092939U (zh) | 梯子 | |
Zhang et al. | Design of Spraying Disinfection Robot Based on Video Teleoperation |
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 | ||
CP01 | Change in the name or title of a patent holder |
Address after: Room 802, building 8, 1818-2, Wenyi West Road, Yuhang District, Hangzhou, Zhejiang 310000 Patentee after: Zhejiang Lishi industrial Interconnection Technology Co.,Ltd. Address before: Room 802, building 8, 1818-2, Wenyi West Road, Yuhang District, Hangzhou, Zhejiang 310000 Patentee before: ZHEJIANG LISHI ROBOT TECHNOLOGY Co.,Ltd. |
|
CP01 | Change in the name or title of a patent holder |