CN1499324A - 一种机器人位置和姿态的推算定位方法及装置 - Google Patents
一种机器人位置和姿态的推算定位方法及装置 Download PDFInfo
- Publication number
- CN1499324A CN1499324A CNA021502390A CN02150239A CN1499324A CN 1499324 A CN1499324 A CN 1499324A CN A021502390 A CNA021502390 A CN A021502390A CN 02150239 A CN02150239 A CN 02150239A CN 1499324 A CN1499324 A CN 1499324A
- Authority
- CN
- China
- Prior art keywords
- robot
- theta
- attitude
- wheel
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 13
- 238000005070 sampling Methods 0.000 claims abstract description 21
- 230000033001 locomotion Effects 0.000 claims description 29
- 230000004927 fusion Effects 0.000 claims description 6
- 238000000926 separation method Methods 0.000 claims 1
- 238000006073 displacement reaction Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 238000009795 derivation Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种机器人位置和姿态的推算定位方法及装置,在驱动轮侧加装测量轮,在机器人的每个轮子的各个自由度安装里程计。测量距离的里程计采用相对码盘,测量角度的里程计采用绝对码盘。通过不同的里程计信息的组合,获得多组转弯半径和转向角,再通过信息融合技术得到运动轨迹的转弯半径和转向角,然后利用基于轨迹的运动学新模型获得机器人的位置和方向。基于轨迹的运动学模型是一组位置和姿态的递推公式,它只用到当前的转弯半径、转向角、上一次采样时刻的位置和姿态。与传统的利用两个轮子的里程信息的推算定位法相比,本发明不仅提高了定位精度,提高了抗干扰能力,而且可用于不平整地面,并适合于在线实时定位。
Description
技术领域
本发明属于移动机器人领域中的自定位,具体地说涉及一种机器人位置和姿态的推算定位方法以及用于实现上述方法的装置。
背景技术
传统上移动机器人的运动模型采用速度和转向角的形式描述(参见“董胜龙,陈卫东,席裕庚,多移动机器人编队的分布式控制系统,机器人,第22卷第6期,第434页,2000年”)。移动机器人的定位,就是确定其当前的位置和方向,其中当前的方向又被称之为姿态。利用里程计推算机器人位置和姿态的定位方法称为推算定位法。传统的移动机器人推算定位法的工作原理为:根据上述运动模型,利用两个轮子加装的里程计测出的微小位移,计算出移动机器人的位置和姿态的变化量,通过累加实现移动机器人的自定位(参见“刘传才,杨静宇,江志明,四轮移动机器人的前后轮里程仪系统的误差分析,机器人,第20卷第2期,第143~147页,1998年”)。
目前,移动机器人的推算定位都采用这种利用两个轮子的里程计的推算定位法。这种方法存在的不足之处是:任何一个里程计产生的偏差都会严重影响定位精度。例如,在一个轮子打滑或者遇到突起物时,该轮的里程计测出的位移与实际位移有较大偏差,导致推算出的位置和姿态具有较大误差。
发明内容
本发明的目的在于提供一种移动机器人位置和姿态的推算定位方法。
本发明的又一目的在于提供一种用于实现上述方法的装置。
为实现上述目的,本发明的技术方案是利用多个轮子的里程信息获得多组转弯半径和转向角,再通过信息融合技术得到运动轨迹的转弯半径和转向角,利用基于轨迹的运动学模型获得机器人的位置和方向。在本发明中,利用多个轮子的里程计信息进行推算定位,即使一个轮子的里程计测出的位移与实际位移有较大偏差时,通过信息融合也可以得到准确的运动轨迹信息,从而得到准确的机器人位置和姿态。
本发明提供的用于实现上述方法的装置是在机器人底盘上的驱动轮侧增加了一个测量轮,该驱动轮与该测量轮之间没有机械联系。电动机驱动该驱动轮使机器人运动,控制机器人的运动速度;导向轮控制机器人的运动方向。在测量轮与平衡轮上分别各安装一里程计,记录其运动距离。在导向轮上的二个自由度安装二个里程计,其中一个里程计记录导向轮的运动距离,另一个里程计记录导向轮的偏转角。
由上述的四个里程计采集的数据中的任何二个数据计算出采样期间的转弯半径和转向角,因此可有6组数据。但由于地面不平、测量噪声等随机因素的影响,用这6组数据计算出的转弯半径和转向角的值是不同的。为消除随机因素的影响,获得较准确的转弯半径和转向角,对各组不同的转弯半径和转向角用公知的模糊融合算法形成估计值。
将记录导向轮偏转角的里程计在第i次和第i+1次采样时测量到的导向轮的偏转角记为αi和αi+1,逆时针方向为正。由其余三个里程计在第i次和第i+1次采样期间的运动距离记为S1 ii+1、S2 ii+1、S3 ii+1。
移动机器人的运动基本为圆弧运动和直线运动,当移动机器人为圆弧运动时,由下面的位置和姿态递推公式求取机器人O1点的位置和姿态:
当移动机器人为直线运动时,机器人沿
方向运动,S1 ii+1、S2 ii+1、S3 ii+1非常接近,而且导向轮的转向角αi+1≈0。对S1 ii+1、S2 ii+1、S3 ii+1和αi+1融合形成估计值Sii+1。O1点在第i+1次采样时的位置和姿态Ti+1 O1可由下式获得:
式中:Ti O1为移动机器人在第i次采样时刻的位置和姿态;
Ti+1 O1为移动机器人在i+1次采样时刻的位置和姿态;
rii+1和θii+1分别为利用模糊融合算法形成的移动机器人在任一次采样期间的转弯半径和转向角的估计值。
本发明采用的位置和姿态的递推公式只需当前的转弯半径、转向角、上一次采样时刻的位置和姿态等三个参数,适合于在线实时定位。
附图说明
图1为里程计安装位置示意图;
图2为圆弧运动轨迹时运动模型推导原理示意图。
具体实施方式
请参阅图1。在机器人底盘B上的驱动轮W4侧增加了一个测量轮W1,该驱动轮W4与该测量轮W1之间没有机械联系。电动机M1驱动该驱动轮W4使机器人运动,控制机器人的运动速度;导向轮W3控制机器人的运动方向。在测量轮W1与平衡轮W2上分别各安装一里程计C7和C2,记录其运动距离。在导向轮W3上安装二个里程计C3和C4,其中里程计C3记录导向轮W3的运动距离,另一个里程计C4记录导向轮W3的偏转角。
本例中,里程计C1~C3采用增量型编码器E6D,C4采用绝对型编码器E6CP,计算机采用工业控制计算机ADVANTECH-610。里程计信号输入工业控制计算机,采样周期0.1秒。
请参阅图2。将里程计C4在第i次和第i+1次采样时测量到的导向轮W3的偏转角记为αi和αi+1,逆时针方向为正。由里程计C1~C3在第i次和第i+1次采样期间的运动距离记为S1 ii+1、S2 ii+1、S3 ii+1。由S1 ii+1、S2 ii+1、S3 ii+1和αi+1中的任何两个数据均可计算出第i次和第i+1次采样期间的转弯半径rii+1和转向角θii+1的值,共6组。例如,由S1 ii+1、S2 ii+1计算出rii+1和θii+1的值为:
其中l为W1与W2之间的距离。
其它5组rii+1和θii+1的值的求取与之类似。但由于地面不平、测量噪声等随机因素的影响,利用不同的两个数据计算出的rii+1、θii+1的值是不同的。为消除随机因素的影响,获得较准确的rii+1与θii+1,对各组不同的rii+1与θii+1用公知的模糊融合算法形成估计值。
移动机器人作圆弧运动时,圆弧中心O2可以看作一个旋转关节,取与
方向相同,见图2。O2点的位置在W1与W2之间的直线上,W1在
轴的坐标为rii+1。于是,O2点在第i次采样时的位置和姿态Ti O1可由第i次采样时的位置和姿态Ti O1经平移变换获得,O2点在第i+1次采样时的位置和姿态Ti+1 O2可由Ti O2经旋转变换获得,O1点在第i+1次采样时的位置和姿态Ti+1 O1可由Ti+1 O2经平移变换获得。圆弧运动时,利用融合形成估计值rii+1与θii+1,由下面的位置和姿态递推公式求取机器人O1点的位置和姿态:
直线运动时,机器人沿
方向运动,S1 ii+1、S2 ii+1、D3 ii+1非常接近,而且W3的转向角αi+1≈0。对S1 ii+1、S2 ii+1、S3 ii+1和αi+1融合形成估计值Sii+1。O1点在第i+1次采样时的位置和姿态
可由下式获得:
为进行比较,传统的推算定位利用C1和C2的信息定位,本发明利用C1~C4的信息定位。在平坦地面上,机器人沿半径2米的圆运动一圈。利用传统的推算定位的位置误差为150mm,相对误差为1.2%。利用本发明的推算定位的位置误差为43mm,相对误差为0.3%。在机器人的W2的运动路径放置一个突起物,机器人沿半径2米的圆运动一圈。利用传统的推算定位的位置误差为756mm,相对误差为6%。利用本发明的推算定位的位置误差为91mm,相对误差为0.7%。
由上述可见,本发明不仅提高了定位精度,而且提高了抗干扰能力,可用于不平整地面。
Claims (4)
1、一种机器人位置和姿态的推算定位方法,利用多个里程信息获得多组转弯半径和转向角;
当移动机器人作圆弧运动时,由下面的位置和姿态递推公式求取机器人的位置和姿态:
当移动机器人为直线运动时,机器人的位置和姿态由下式获得:
式中:
为移动机器人在第i次采样时刻的位置和姿态;
为移动机器人在i+1次采样时刻的位置和姿态;
rii+1和θii+1分别为移动机器人在第i和第i+1次采样期间的转弯半径和转向角。
2、如权利要求1所述的方法,其特征在于,rii+1和θii+1分别为经过模糊融合算法得到的移动机器人在第i和第i+1次采样期间的转弯半径和转向角的估计值。
3、一种用于实现上述方法的装置,在底座上设置有:
一测量轮,分离的设置在驱动轮的一侧;
测量轮与平衡轮上分别安装一个里程计,测量驱动轮和测量轮的运动距离;
导向轮上的二个自由度安装二个里程计,其中一个里程计测量导向轮的运动距离,另一个里程计测量导向轮的偏转角;
一电动机,带动驱动轮,使移动机器人运动,并控制移动机器人的运动速度;
上述各里程计测量的信号输入计算机。
4、如权利要求3所述的装置,其特征在于,所述四个里程计中,测量导向轮偏转角的里程计为绝对型编码器,其余三个测量距离的里程计为相对型编码器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNA021502390A CN1499324A (zh) | 2002-11-06 | 2002-11-06 | 一种机器人位置和姿态的推算定位方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CNA021502390A CN1499324A (zh) | 2002-11-06 | 2002-11-06 | 一种机器人位置和姿态的推算定位方法及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN1499324A true CN1499324A (zh) | 2004-05-26 |
Family
ID=34233921
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CNA021502390A Pending CN1499324A (zh) | 2002-11-06 | 2002-11-06 | 一种机器人位置和姿态的推算定位方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN1499324A (zh) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101049693B (zh) * | 2006-04-04 | 2010-05-26 | 三星电子株式会社 | 控制系统、具有该控制系统的移动机器人装置及控制方法 |
CN1994689B (zh) * | 2005-12-28 | 2011-02-16 | 松下电器产业株式会社 | 机器人及机器人检测自动化方法 |
CN102637035A (zh) * | 2012-05-03 | 2012-08-15 | 慈溪思达电子科技有限公司 | 自动移动平台的局部定位系统 |
CN103170976A (zh) * | 2013-03-13 | 2013-06-26 | 西北工业大学 | 二自由度机器人运动控制方法 |
CN104316059A (zh) * | 2014-11-05 | 2015-01-28 | 中国科学院嘉兴微电子与系统工程中心 | 由里程计获得车辆经纬度的航位推算导航定位方法及系统 |
CN104475504A (zh) * | 2014-11-04 | 2015-04-01 | 上海新时达电气股份有限公司 | 机器人折弯实时跟随方法及其装置 |
CN104932493A (zh) * | 2015-04-01 | 2015-09-23 | 上海物景智能科技有限公司 | 一种自主导航的移动机器人及其自主导航的方法 |
CN106125742A (zh) * | 2016-08-30 | 2016-11-16 | 宁波菜鸟智能科技有限公司 | 机器人的行走控制方法、装置及系统 |
CN106292662A (zh) * | 2016-08-09 | 2017-01-04 | 衣佳鑫 | 机器人轨迹绘制方法及系统 |
CN106272433A (zh) * | 2016-09-28 | 2017-01-04 | 中科新松有限公司 | 自主移动机器人的轨迹定位系统及方法 |
CN106933221A (zh) * | 2015-12-29 | 2017-07-07 | 哈尔滨恒誉名翔科技有限公司 | 一种基于多传感器的轮式机器人系统 |
CN107422737A (zh) * | 2017-08-08 | 2017-12-01 | 珠海市微半导体有限公司 | 机器人是否碰到障碍物的检测方法和系统及芯片 |
CN108759853A (zh) * | 2018-06-15 | 2018-11-06 | 浙江国自机器人技术有限公司 | 一种机器人定位方法、系统、设备及计算机可读存储介质 |
CN109099915A (zh) * | 2018-06-27 | 2018-12-28 | 未来机器人(深圳)有限公司 | 移动机器人定位方法、装置、计算机设备和存储介质 |
CN110954129A (zh) * | 2019-12-19 | 2020-04-03 | 北京猎户星空科技有限公司 | 一种里程计数据的确定方法、装置、设备及介质 |
CN111912403A (zh) * | 2020-08-04 | 2020-11-10 | 国以贤智能科技(上海)股份有限公司 | 一种叉车的定位方法及叉车 |
CN114216460A (zh) * | 2021-11-23 | 2022-03-22 | 优兔创新有限公司 | 里程计定位方法、全局定位方法及定位系统 |
-
2002
- 2002-11-06 CN CNA021502390A patent/CN1499324A/zh active Pending
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1994689B (zh) * | 2005-12-28 | 2011-02-16 | 松下电器产业株式会社 | 机器人及机器人检测自动化方法 |
CN101049693B (zh) * | 2006-04-04 | 2010-05-26 | 三星电子株式会社 | 控制系统、具有该控制系统的移动机器人装置及控制方法 |
CN102637035A (zh) * | 2012-05-03 | 2012-08-15 | 慈溪思达电子科技有限公司 | 自动移动平台的局部定位系统 |
CN103170976A (zh) * | 2013-03-13 | 2013-06-26 | 西北工业大学 | 二自由度机器人运动控制方法 |
CN103170976B (zh) * | 2013-03-13 | 2014-11-26 | 西北工业大学 | 二自由度机器人运动控制方法 |
CN104475504A (zh) * | 2014-11-04 | 2015-04-01 | 上海新时达电气股份有限公司 | 机器人折弯实时跟随方法及其装置 |
CN104316059A (zh) * | 2014-11-05 | 2015-01-28 | 中国科学院嘉兴微电子与系统工程中心 | 由里程计获得车辆经纬度的航位推算导航定位方法及系统 |
WO2016070723A1 (zh) * | 2014-11-05 | 2016-05-12 | 中国科学院嘉兴微电子与系统工程中心 | 由里程计获得车辆经纬度的航位推算导航定位方法及系统 |
CN104316059B (zh) * | 2014-11-05 | 2017-08-25 | 中国科学院嘉兴微电子与系统工程中心 | 由里程计获得车辆经纬度的航位推算导航定位方法及系统 |
CN104932493A (zh) * | 2015-04-01 | 2015-09-23 | 上海物景智能科技有限公司 | 一种自主导航的移动机器人及其自主导航的方法 |
CN104932493B (zh) * | 2015-04-01 | 2017-09-26 | 上海物景智能科技有限公司 | 一种自主导航的移动机器人及其自主导航的方法 |
CN106933221A (zh) * | 2015-12-29 | 2017-07-07 | 哈尔滨恒誉名翔科技有限公司 | 一种基于多传感器的轮式机器人系统 |
CN106292662A (zh) * | 2016-08-09 | 2017-01-04 | 衣佳鑫 | 机器人轨迹绘制方法及系统 |
CN106125742A (zh) * | 2016-08-30 | 2016-11-16 | 宁波菜鸟智能科技有限公司 | 机器人的行走控制方法、装置及系统 |
CN106125742B (zh) * | 2016-08-30 | 2019-04-09 | 宁波菜鸟智能科技有限公司 | 机器人的行走控制方法、装置及系统 |
CN106272433B (zh) * | 2016-09-28 | 2019-03-26 | 中科新松有限公司 | 自主移动机器人的轨迹定位系统及方法 |
CN106272433A (zh) * | 2016-09-28 | 2017-01-04 | 中科新松有限公司 | 自主移动机器人的轨迹定位系统及方法 |
CN107422737A (zh) * | 2017-08-08 | 2017-12-01 | 珠海市微半导体有限公司 | 机器人是否碰到障碍物的检测方法和系统及芯片 |
CN108759853A (zh) * | 2018-06-15 | 2018-11-06 | 浙江国自机器人技术有限公司 | 一种机器人定位方法、系统、设备及计算机可读存储介质 |
CN109099915A (zh) * | 2018-06-27 | 2018-12-28 | 未来机器人(深圳)有限公司 | 移动机器人定位方法、装置、计算机设备和存储介质 |
CN109099915B (zh) * | 2018-06-27 | 2020-12-25 | 未来机器人(深圳)有限公司 | 移动机器人定位方法、装置、计算机设备和存储介质 |
CN110954129A (zh) * | 2019-12-19 | 2020-04-03 | 北京猎户星空科技有限公司 | 一种里程计数据的确定方法、装置、设备及介质 |
CN111912403A (zh) * | 2020-08-04 | 2020-11-10 | 国以贤智能科技(上海)股份有限公司 | 一种叉车的定位方法及叉车 |
CN111912403B (zh) * | 2020-08-04 | 2021-05-14 | 国以贤智能科技(上海)股份有限公司 | 一种叉车的定位方法及叉车 |
CN114216460A (zh) * | 2021-11-23 | 2022-03-22 | 优兔创新有限公司 | 里程计定位方法、全局定位方法及定位系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1499324A (zh) | 一种机器人位置和姿态的推算定位方法及装置 | |
West et al. | Design of a holonomic omnidirectional vehicle | |
CN1734233A (zh) | 大口径钢管截面形状尺寸测量系统及测量方法 | |
CN109916431A (zh) | 一种针对四轮移动机器人的车轮编码器标定算法 | |
CN104881025A (zh) | 一种地下矿用车辆的反应式导航控制方法 | |
CN105009012A (zh) | 用于无损检测的独立完整追踪方法及设备 | |
CN109823393A (zh) | 一种智能驾驶车辆轨迹跟踪控制方法 | |
CN112097792B (zh) | 一种阿克曼模型移动机器人里程计标定方法 | |
CN111610523A (zh) | 一种轮式移动机器人的参数校正方法 | |
CN102331781A (zh) | 小车左右直线同步行走控制电路、控制方法及检测装置 | |
CN107632559A (zh) | 一种基于图像处理的共平面板球实验系统及其工作方法 | |
CN105881537A (zh) | 一种三核四轴履带式高速天然气管道机器人控制系统 | |
Martínez et al. | Kinematic modelling of tracked vehicles by experimental identification | |
Song et al. | Design and control of an omnidirectional mobile robot with steerable omnidirectional wheels | |
Fang et al. | A study on intelligent path following and control for vision-based automated guided vehicle | |
JP3267323B2 (ja) | 無人車の制御装置 | |
CN1546288A (zh) | 弯曲焊缝自主移动焊接机器人系统 | |
Fan et al. | Experimental evaluation of an encoder trailer for dead-reckoning in tracked mobile robots | |
CN109945014B (zh) | 一种管道机器人用行走驱动机构 | |
CN112130558A (zh) | 一种基于差速轮组agv的导航系统及控制方法 | |
Lundgren | Path tracking and obstacle avoidance for a miniature robot | |
CN208931479U (zh) | 一种带减震机构和转向角度检测功能的agv驱动单元 | |
CN218822229U (zh) | 一种轨道式巡检机器人定位测量装置 | |
Tu et al. | Calibration method of Mecanum wheeled mobile robot odometer | |
Luan et al. | Design of motion control system for omnidirectional four-drive mobile robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C12 | Rejection of a patent application after its publication | ||
RJ01 | Rejection of invention patent application after publication |