CN102637035A - 自动移动平台的局部定位系统 - Google Patents
自动移动平台的局部定位系统 Download PDFInfo
- Publication number
- CN102637035A CN102637035A CN2012101343917A CN201210134391A CN102637035A CN 102637035 A CN102637035 A CN 102637035A CN 2012101343917 A CN2012101343917 A CN 2012101343917A CN 201210134391 A CN201210134391 A CN 201210134391A CN 102637035 A CN102637035 A CN 102637035A
- Authority
- CN
- China
- Prior art keywords
- wheel
- driving wheel
- mobile platform
- code
- automatic mobile
- 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
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
自动移动平台的局部定位系统,包括机身,在所述的机身底部的左右两边设置左驱动轮和右驱动轮,所述的左驱动轮和右驱动轮同轴设置,所述的左驱动轮连接左减速箱,所述的左减速箱连接左驱动电机,所述的左驱动电机安装左编码盘,所述的左编码盘输出编码信号,所述的右驱动轮连接右减速箱,所述的右减速箱连接右驱动电机,所述的右驱动电机右编码盘,所述的右编码盘输出编码信号,在所述的机身底部还设置一个支撑轮,还包括电子控制装置,连接所述的左驱动电机、右驱动电机、左编码盘和右编码盘,所述的电子控制装置设置微处理器,所述的微处理器设置局部定位算法,所述的局部定位算法可以在局部范围内为所述的自动移动平台提供有效的定位数据。
Description
技术领域
本发明涉及一种自动移动平台的局部定位系统,属于移动机器人控制技术领域。
背景技术
定位是自动移动平台确定自身位置的功能,是对人类方位感的模拟。基于可靠的定位数据,自动移动平台才可以进行任务规划,执行设定任务。目前对定位的解决方案主要有以下几种方法。1、使用全球定位系统。这种方法只能适用于室外移动平台,并且定位精度也是有限的;2、使用激光雷达测距仪。这种设备一次只能测量一个方向上的距离,因为需要加装旋转装置进行一定范围内扫描获得单个平面内的障碍物信息,然后与环境地图进行配对,获取位置信息。因此这种定位方式具有设备价格昂贵,获得信息不全面,算法实时性差的缺点;3、使用计算机视觉系统。这种方法可以获得丰富的环境信息,不仅可以获取视觉范围内的障碍物距离信息,还可以识别特征点。因此即可以通过特征点配对的方式获取位置信息,也可以与环境地图进行配对获取位置信息。但是计算机视觉系统不仅硬件设备价格昂贵,而且算法复杂,实时性差,不能满足实际应用要求。
发明内容
本发明的目的是为了提供一种可用于自动移动平台的局部定位系统,采集安装在驱动电机上的编码器信号进行局部定位计算,具有系统结构简单,定位算法实时性高,运算速度快的优点。
本发明解决其技术问题所采用的技术方案是:
自动移动平台的局部定位系统,包括起支撑和容纳作用的机身,在所述的机身底部的左右两边设置左驱动轮和右驱动轮,所述的左驱动轮和右驱动轮同轴设置,所述的左驱动轮连接左减速箱,所述的左减速箱连接左驱动电机,所述的左驱动电机的旋转轴一端安装左编码盘,所述的左编码盘输出可判断方向的编码信号,所述的右驱动轮连接右减速箱,所述的右减速箱连接右驱动电机,所述的右驱动电机的旋转轴一端安装右编码盘,所述的右编码盘输出可判断方向的编码信号,在所述的机身底部还设置一个支撑轮,还包括电子控制装置,所述的电子控制装置连接所述的左驱动电机、右驱动电机、左编码盘和右编码盘,所述的电子控制装置设置可执行控制算法的微处理器,所述的微处理器设置局部定位算法,所述的局部定位算法包括一下步骤:
(1)在采样周期内,所述的微处理器记录所述的左编码器和右编码盘输出的编码信号的脉冲数LPCount和RPCount;
(2)计算在采样周期内所述的自动移动平台旋转角度△θ= 2π·R(RPCount - LPCount)/(LrN),累计可以获得所述的自动移动平台的方位角θ=θ+△θ,其中参数r为所述的左减速箱和右减速箱的减速比,参数R为所述的左驱动轮和右驱动轮的半径,参数L为所述的左驱动轮和右驱动轮的距离, 参数N为所述的左编码盘和右编码盘旋转一圈输出编码器信号的数量;
(3)计算在采样周期内,所述的自动移动平台的移动距离d=( RPCount + LPCount) R/(r N);
(4)计算在采样周期内,所述的自动移动平台在x坐标轴上的移动距离△x=dcosθ,在y坐标轴上的移动距离△y=dsinθ;
(5)累计计算获得所述的自动移动平台的x坐标值x=x+△x,累计计算获得所述的自动移动平台的y坐标值y=y+△y。
本发明的有益效果主要表现在:1、局部定位算法简单可靠,运算速度快;2、在局部范围内定位性能满足实际应用要求;3、对系统硬件要求不高,应用范围广。
附图说明
图1是自动移动平台的侧视图;
图2是自动移动平台的左侧驱动结构示意图;
图3是自动移动平台的运动模型。
具体实施方式
下面结合附图对本发明作进一步描述。
参照图1—图3,自动移动平台的局部定位系统,包括起支撑和容纳作用的机身1,在所述的机身1底部的左右两边设置左驱动轮3和右驱动轮2,所述的左驱动轮3和右驱动轮2同轴设置,所述的左驱动轮3连接左减速箱4,所述的左减速箱4连接左驱动电机5,所述的左驱动电机5的旋转轴一端安装左编码盘6,所述的左编码盘6输出可判断方向的编码信号。同样,所述的右驱动轮2连接右减速箱,所述的右减速箱连接右驱动电机,所述的右驱动电机的旋转轴一端安装右编码盘,所述的右编码盘输出可判断方向的编码信号,在所述的机身1底部还设置一个支撑轮。在所述的左驱动电机5和右驱动电机的驱动下,所述的自动移动平台可以直行,后退,转弯和原地旋转。
还包括进行集中控制的电子控制装置,所述的电子控制装置连接所述的左驱动电机5、右驱动电机、左编码盘6和右编码盘,所述的电子控制装置设置可执行控制算法的微处理器,以及电机驱动电路和障碍物检测电路。所述的电机驱动电路可以驱动所述的左驱动电机5和右驱动电机进行正转、反转以及制动。所述的障碍物检测电路用于测量前方障碍物的距离,避免碰撞,也可以为路径规户提供信息。所述的左编码盘6和右编码盘输出的编码器信号连接所述的微处理器的端口上。
所述的微处理器设置局部定位算法,所述的局部定位算法包括一下步骤:
(1)在采样周期内,所述的微处理器记录所述的左编码器6和右编码盘输出的编码信号的脉冲数LPCount和RPCount;
(2)计算在采样周期内所述的自动移动平台旋转角度△θ= 2π·R(RPCount - LPCount)/(LrN),累计可以获得所述的自动移动平台的方位角θ=θ+△θ,其中参数r为所述的左减速箱4和右减速箱的减速比,参数R为所述的左驱动轮3和右驱动轮2的半径,参数L为所述的左驱动轮3和右驱动轮2的距离, 参数N为所述的左编码盘6和右编码盘旋转一圈输出编码器信号的数量;
(3)计算在采样周期内,所述的自动移动平台的移动距离d=( RPCount + LPCount) R/(r N);
(4)计算在采样周期内,所述的自动移动平台在x坐标轴上的移动距离△x=dcosθ,在y坐标轴上的移动距离△y=dsinθ;
(5)累计计算获得所述的自动移动平台的x坐标值x=x+△x,累计计算获得所述的自动移动平台的y坐标值y=y+△y。
在所述的步骤(2)中,将采样周期内所述的自动移动平台的运动近似为两轮差速的旋转运动,如图3所示,因此方位角的变化△θ等于扇形的圆心角,该扇形的半径为L,弧长为两轮行走距离的差值。
在所述的步骤(3)中,所述的自动移动平台的移动距离d为所述的左驱动轮3和右驱动轮2的行走距离的平均值。在所述的步骤(4)中,将所述的自动移动平台的移动距离d近似为朝方位角θ方向进行的直线运动,因为通过三角形定律就可以计算出所述的自动移动平台的在x、y坐标轴上的移动距离。
综上所述,本专利基于两个驱动电机上的编码器输出的信号进行自动移动平台的位置计算,在局部范围内定位性能满足实际应用要求,具有算法简单可靠,运算速度快,对系统硬件要求不高,应用范围广的优点。
Claims (1)
1.自动移动平台的局部定位系统,包括起支撑和容纳作用的机身,在所述的机身底部的左右两边设置左驱动轮和右驱动轮,所述的左驱动轮和右驱动轮同轴设置,所述的左驱动轮连接左减速箱,所述的左减速箱连接左驱动电机,所述的左驱动电机的旋转轴一端安装左编码盘,所述的左编码盘输出可判断方向的编码信号,所述的右驱动轮连接右减速箱,所述的右减速箱连接右驱动电机,所述的右驱动电机的旋转轴一端安装右编码盘,所述的右编码盘输出可判断方向的编码信号,在所述的机身底部还设置一个支撑轮,还包括电子控制装置,所述的电子控制装置连接所述的左驱动电机、右驱动电机、左编码盘和右编码盘,所述的电子控制装置设置可执行控制算法的微处理器,其特征在于:所述的微处理器设置局部定位算法,所述的局部定位算法包括一下步骤:
(1)在采样周期内,所述的微处理器记录所述的左编码器和右编码盘输出的编码信号的脉冲数LPCount和RPCount;
(2)计算在采样周期内所述的自动移动平台旋转角度△θ= 2π·R·(RPCount - LPCount)/(L·r·N),累计可以获得所述的自动移动平台的方位角θ=θ+△θ,其中参数r为所述的左减速箱和右减速箱的减速比,参数R为所述的左驱动轮和右驱动轮的半径,参数L为所述的左驱动轮和右驱动轮的距离, 参数N为所述的左编码盘和右编码盘旋转一圈输出编码器信号的数量;
(3)计算在采样周期内,所述的自动移动平台的移动距离d=( RPCount + LPCount) ·R·π/(r ·N);
(4)计算在采样周期内,所述的自动移动平台在x坐标轴上的移动距离△x=d·cosθ,在y坐标轴上的移动距离△y=d·sinθ;
(5)累计计算获得所述的自动移动平台的x坐标值x=x+△x,累计计算获得所述的自动移动平台的y坐标值y=y+△y。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012101343917A CN102637035A (zh) | 2012-05-03 | 2012-05-03 | 自动移动平台的局部定位系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012101343917A CN102637035A (zh) | 2012-05-03 | 2012-05-03 | 自动移动平台的局部定位系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN102637035A true CN102637035A (zh) | 2012-08-15 |
Family
ID=46621450
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2012101343917A Pending CN102637035A (zh) | 2012-05-03 | 2012-05-03 | 自动移动平台的局部定位系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102637035A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104932493A (zh) * | 2015-04-01 | 2015-09-23 | 上海物景智能科技有限公司 | 一种自主导航的移动机器人及其自主导航的方法 |
CN109085835A (zh) * | 2018-08-28 | 2018-12-25 | 扬州方棱机械有限公司 | 一种生成割草工作区域虚拟边界的方法 |
CN111122791A (zh) * | 2020-01-02 | 2020-05-08 | 北京海益同展信息科技有限公司 | 气体浓度检测设备、系统和方法 |
CN114305222A (zh) * | 2021-12-23 | 2022-04-12 | 湖南格兰博智能科技有限责任公司 | 一种扫地机器人的偏航角检测方法及扫地机器人 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001265438A (ja) * | 2000-03-16 | 2001-09-28 | Sumitomo Heavy Ind Ltd | 無人搬送台車 |
CN1499324A (zh) * | 2002-11-06 | 2004-05-26 | 中国科学院自动化研究所 | 一种机器人位置和姿态的推算定位方法及装置 |
EP1652754B1 (en) * | 2004-10-28 | 2007-06-13 | Jtekt Corporation | Steering control apparatus |
CN101665068A (zh) * | 2009-09-24 | 2010-03-10 | 浙江大学 | 一种机器人车体均匀着地装置 |
CN101885351A (zh) * | 2010-07-15 | 2010-11-17 | 南京航空航天大学 | 可分式差速驱动装置及其全方位移动自动导引车 |
CN101885350A (zh) * | 2010-07-15 | 2010-11-17 | 南京航空航天大学 | 全方位自动导引车的路径自适应跟踪控制方法 |
-
2012
- 2012-05-03 CN CN2012101343917A patent/CN102637035A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001265438A (ja) * | 2000-03-16 | 2001-09-28 | Sumitomo Heavy Ind Ltd | 無人搬送台車 |
CN1499324A (zh) * | 2002-11-06 | 2004-05-26 | 中国科学院自动化研究所 | 一种机器人位置和姿态的推算定位方法及装置 |
EP1652754B1 (en) * | 2004-10-28 | 2007-06-13 | Jtekt Corporation | Steering control apparatus |
CN101665068A (zh) * | 2009-09-24 | 2010-03-10 | 浙江大学 | 一种机器人车体均匀着地装置 |
CN101885351A (zh) * | 2010-07-15 | 2010-11-17 | 南京航空航天大学 | 可分式差速驱动装置及其全方位移动自动导引车 |
CN101885350A (zh) * | 2010-07-15 | 2010-11-17 | 南京航空航天大学 | 全方位自动导引车的路径自适应跟踪控制方法 |
Non-Patent Citations (2)
Title |
---|
李航等: "两轮移动机器人控制系统研究", 《机床与液压》, no. 7, 31 July 2006 (2006-07-31) * |
罗颖: "基于SSPF算法的移动机器人全局定位研究", 《中国优秀硕士学位论文全文数据库信息科技辑(月刊 )》, 31 January 2009 (2009-01-31) * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104932493A (zh) * | 2015-04-01 | 2015-09-23 | 上海物景智能科技有限公司 | 一种自主导航的移动机器人及其自主导航的方法 |
CN104932493B (zh) * | 2015-04-01 | 2017-09-26 | 上海物景智能科技有限公司 | 一种自主导航的移动机器人及其自主导航的方法 |
CN109085835A (zh) * | 2018-08-28 | 2018-12-25 | 扬州方棱机械有限公司 | 一种生成割草工作区域虚拟边界的方法 |
CN111122791A (zh) * | 2020-01-02 | 2020-05-08 | 北京海益同展信息科技有限公司 | 气体浓度检测设备、系统和方法 |
CN114305222A (zh) * | 2021-12-23 | 2022-04-12 | 湖南格兰博智能科技有限责任公司 | 一种扫地机器人的偏航角检测方法及扫地机器人 |
CN114305222B (zh) * | 2021-12-23 | 2022-12-06 | 湖南格兰博智能科技有限责任公司 | 一种扫地机器人的偏航角检测方法及扫地机器人 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106740819B (zh) | 一种无人驾驶公交车的自动控制系统 | |
CN106541945B (zh) | 一种基于icp算法的无人车自动泊车方法 | |
CN103661599B (zh) | 一种车辆转弯轨迹预测系统和方法 | |
CN104932493B (zh) | 一种自主导航的移动机器人及其自主导航的方法 | |
JP6232447B2 (ja) | 誘導システム及び方法 | |
CN110716558A (zh) | 一种基于数字孪生技术的非公开道路用自动驾驶系统 | |
US10214223B1 (en) | Method and apparatus for determining vehicle location based on motor feedback | |
US10654522B2 (en) | System for actively monitoring the steering angle of a vehicle using a kingpin sensor | |
CN105716619A (zh) | 一种基于gps-rtk技术的无人割草车室外导航与控制方法 | |
CN108762260A (zh) | 基于差分gps的履带式自主导航机器人及其导航方法 | |
CN105015521A (zh) | 一种基于磁钉的大型车辆自动停靠装置 | |
CN105278533A (zh) | 一种全向移动平台导航方法 | |
CN102637035A (zh) | 自动移动平台的局部定位系统 | |
US20190163201A1 (en) | Autonomous Vehicle Sensor Compensation Using Displacement Sensor | |
CN111966104A (zh) | 一种基于磁钉的融合导航车辆自动驾驶系统及方法 | |
CN103019240A (zh) | 一种agv小车平面定位导航系统及方法 | |
CN108216009A (zh) | 一种多信息融合的自适应前照灯系统及其控制方法 | |
CN208859276U (zh) | 多传感器场域感知的无轨移动平台 | |
CN203490506U (zh) | 一种车载激光自动导向控制系统 | |
CN206171364U (zh) | 一种无人车电气控制系统 | |
CN113460049B (zh) | 一种机器人驾驶的井下顺槽运输无轨胶轮车及其控制方法 | |
CN207540557U (zh) | 一种用于agv小车的短时精确定位的装置 | |
EP3850305A1 (en) | Driving surface friction estimations for vehicles | |
CN209674238U (zh) | 一种多感融合的高速高载重小车 | |
CN205819052U (zh) | 一种新型无人驾驶汽车用避障系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20120815 |