CN106527443A - 全向移动agv导航纠偏方法 - Google Patents

全向移动agv导航纠偏方法 Download PDF

Info

Publication number
CN106527443A
CN106527443A CN201611058144.8A CN201611058144A CN106527443A CN 106527443 A CN106527443 A CN 106527443A CN 201611058144 A CN201611058144 A CN 201611058144A CN 106527443 A CN106527443 A CN 106527443A
Authority
CN
China
Prior art keywords
car
magnetic sensor
magnetic
situation
magnetic stripe
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
Application number
CN201611058144.8A
Other languages
English (en)
Other versions
CN106527443B (zh
Inventor
李远桥
李明
李波
段三军
宋策
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Specialized Machinery
Original Assignee
Beijing Institute of Specialized Machinery
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Specialized Machinery filed Critical Beijing Institute of Specialized Machinery
Priority to CN201611058144.8A priority Critical patent/CN106527443B/zh
Publication of CN106527443A publication Critical patent/CN106527443A/zh
Application granted granted Critical
Publication of CN106527443B publication Critical patent/CN106527443B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0259Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • G05D1/0263Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic strips
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D2201/00Application
    • G05D2201/02Control of position of land vehicles
    • G05D2201/0207Unmanned vehicle for inspecting or visiting an area

Abstract

本发明涉及一种全向移动AGV导航纠偏方法,属于麦克纳姆轮全向移动AGV的导航定位技术领域。本发明根据前后磁传感器反馈的磁条位置信息,通过一种信息处理算法将得到的复杂的实际情况解析为两种独立且方便处理的简单情况,方便处理。从而针对麦克纳姆轮全向移动AGV的特性进行偏差矫正。从磁传感器反馈的信息将会被实时处理并用于计算偏差程度,依据偏差程度对偏差矫正速度进行赋值。从而实现了麦克纳姆轮全向移动AGV的高精度导航纠偏。该方法依据麦克纳姆轮全向移动AGV的行驶特性实现,充分利用了底盘平台的全向移动特点。

Description

全向移动AGV导航纠偏方法
技术领域
[0001] 本发明涉及麦克纳姆轮全向移动AGV的导航定位技术领域,具体涉及一种全向移动AGV导航纠偏方法。
背景技术
[0002] 麦克纳姆轮全向移动平台作为一种灵活的运载平台解决方案被广泛地应用于航空、航天、教育、医疗、工业、物流等各个领域。而目前AGV (自动引导运输车)主要针对舵轮形式AGV使用磁条导引加地标定位的导航定位方案,该种方案在对小车进行纠偏时往往通过前方一个或两个磁传感器进行纠偏,并没有针对麦克纳姆轮全向移动AGV的行驶特点进行设计。
发明内容
[0003](一)要解决的技术问题
[0004] 本发明要解决的技术问题是:如何消除麦克纳姆轮AGV在行驶过程中的偏差,从而实现AGV的高精度导航纠偏。
[0005] (二)技术方案
[0006] 为了解决上述技术问题,本发明提供了一种全向移动AGV导航纠偏方法,包括以下步骤:
[0007] 如果AGV车体发生第一种偏离情况,即车体中心点在车体下方磁条的磁条路径上,同时车体中轴线与磁条路径有一个不为零的夹角,则根据磁传感器返回的值,分析车体与磁条的偏离程度,并计算出旋转速度ω进行车身姿态调整,实现纠偏;
[0008] 如果车体发生第二种偏离情况,S卩车体中心点不在磁条路径上,同时车体中轴线与磁条路径平行,则根据磁传感器返回的值,分析车体与磁条的偏离程度,并计算出横移速度X进行车身姿态调整,实现纠偏;
[0009]如果车体发生的偏移情况为第一种与第二种情况的复合偏离情况,即既有旋转偏移,又有横向偏移的情况,则将得到的复合偏离情况拆解为第一种与第二种情况,再通过其各自对应的计算方式计算出相应的调整速度X与ω,同时进行横移和旋转调整,实现纠偏;
[0010] 所述磁传感器为前、后两个磁传感器,分别安装在车体前端与后端;若车体正常行驶,没有任何偏移,则车体中心点在磁条路径上,同时车体中轴线与磁条路径之间没有夹角。
[0011] 优选地,对于第一种情况,设前磁传感器的值为a,后磁传感器的值为b,前后磁传感器之间的距离为L,则计算前后磁传感器之间的数值差的绝对值|a_b I与和的一半(a+b) /2,并计算出车体中轴线与磁条之间的夹角α的三角函数tana = \a~h\/L,由此计算出夹角a,将夹角a乘以系数得到旋转速度ω,利用旋转速度ω进行车身姿态调整,实现纠偏,其中所述系数根据车体旋转到最偏程度时,按照夹角α越小旋转速度ω相应地越小的理论所进行的试验得到。
[0012] 优选地,所述系数为0.02ο
[0013] 优选地,对于第二种情况,将前、后磁传感器的值之和的一半(a+b) /2减去前磁传感器或后磁传感器的中心值得到车体下方磁条的中点与车体中心点之间的距离d,然后计算横移速度X = 2.5d,利用横移速度X进行车身姿态调整,实现纠偏。
[0014] 优选地,对于所述复合偏离情况,将前、后磁传感器的值之和的一半(a+b) /2减去前磁传感器或后磁传感器的中心值得到车体下方磁条的中点与车体中心点之间的距离d,然后计算横移速度x = ytana+d*2.5/cosa,利用x、y的复合速度进行车身姿态调整,实现纠偏,其中y为预设的车体前进速度。
[0015](三)有益效果
[0016] 本发明根据前后磁传感器反馈的磁条位置信息,通过一种信息处理算法将得到的复杂的实际情况解析为两种独立且方便处理的简单情况,方便处理。从而针对麦克纳姆轮全向移动AGV的特性进行偏差矫正。从磁传感器反馈的信息将会被实时处理并用于计算偏差程度,依据偏差程度对偏差矫正速度进行赋值。从而实现了麦克纳姆轮全向移动AGV的高精度导航纠偏。该方法依据麦克纳姆轮全向移动AGV的行驶特性实现,充分利用了底盘平台的全向移动特点。
附图说明
[0017]图1为本发明实施例的旋转偏离情况示意图;
[0018]图2为本发明实施例的横向偏离情况示意图;
[0019]图3为本发明实施例的复合偏离情况示意图。
具体实施方式
[0020] 为使本发明的目的、内容、和优点更加清楚,下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。
[0021] 本发明实施例提供了一种全向移动AGV导航纠偏方法,包括以下步骤:
[0022] 如图1所示,如果AGV车体发生第一种偏离情况,即车体中心点在车体下方磁条的磁条路径上,同时车体中轴线与磁条路径有一个不为零的夹角,则根据磁传感器返回的值,分析车体与磁条的偏离程度,并计算出旋转速度ω进行车身姿态调整,实现纠偏;磁传感器的位置为:磁传感器为前、后两个磁传感器,分别安装在车体前端与后端(图1中上、下两个小矩形,图1中左、右两侧的四个大矩形为车轮),前、后两个传感器返回的值均为从左向右依次为I至9 (对应图中不同的圆圈,若第一个圆圈亮则返回的值为I,第二个圆圈亮则返回的值为2,依次类推,若最后一个即第9个圆圈亮则值为9,或者相邻的两个圆圈,或相邻的三个圆圈亮,若两个或三个圆圈亮,则返回的值为这两个或三个圆圈对应值的平均值)。磁条的位置为:若车体正常行驶,没有任何偏移,则车体中心点在磁条路径上,同时车体中轴线与磁条路径之间没有夹角,磁条是布置在地面上。
[0023] 对于第一种情况,设前磁传感器的值为a,后磁传感器的值为b,前后磁传感器之间的距离为定值L,则计算前后磁传感器之间的数值差的绝对值I a-b I与和的一半(a+b) /2,并计算出车体中轴线与磁条之间的夹角α的三角函数tana = \a~h\/L,由此计算出夹角a,将夹角α乘以系数得到旋转速度ω,利用旋转速度ω进行车身姿态调整,实现纠偏,其中所述系数根据车体旋转到最偏程度时,按照夹角α越小旋转速度ω相应地越小的理论所进行的试验得到,本实施例中系数为0.02。
[0024] 如图2所示,如果车体发生第二种偏离情况,即车体中心点不在磁条路径上,同时车体中轴线与磁条路径平行,则根据磁传感器返回的值,分析车体与磁条的偏离程度,并计算出横移速度X进行车身姿态调整,实现纠偏;
[0025] 对于第二种情况,将前、后磁传感器的值之和的一半(a+b) /2减去前磁传感器或后磁传感器的中心值得到车体下方磁条的中点与车体中心点之间的距离d,然后计算横移速度x = 2.5d,利用横移速度X进行车身姿态调整,实现纠偏,这个过程中利用了中点距离d越小横移速度X越小的线性关系。
[0026]大多数的偏移情况会是上述两种情况的复合,即既有旋转偏移,又有横向偏移的情况,此时将需要同时进行横移和旋转调整操作实现纠偏。如图3所示,如果车体发生的偏移情况为第一种与第二种情况的复合偏离情况,则将得到的复合偏离情况拆解为第一种与第二种情况,再通过其各自对应的计算方式计算出相应的调整速度X与ω,同时进行横移和旋转调整,实现纠偏;
[0027] 对于复合偏离情况,将前、后磁传感器的值之和的一半(a+b) /2减去前磁传感器或后磁传感器的中心值得到车体下方磁条的中点与车体中心点之间的距离d,然后计算横移速度x = ytana+d*2.5/cosa,利用x、y的复合速度进行车身姿态调整(车体以x、y的复合速度(两个速度矢量x、y之和)前进,以便沿着磁条前进),实现纠偏,其中y为预设的车体前进速度。
[0028]以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。

Claims (5)

1.一种全向移动AGV导航纠偏方法,其特征在于,包括以下步骤: 如果AGV车体发生第一种偏离情况,即车体中心点在车体下方磁条的磁条路径上,同时车体中轴线与磁条路径有一个不为零的夹角,则根据磁传感器返回的值,分析车体与磁条的偏离程度,并计算出旋转速度ω进行车身姿态调整,实现纠偏; 如果车体发生第二种偏离情况,即车体中心点不在磁条路径上,同时车体中轴线与磁条路径平行,则根据磁传感器返回的值,分析车体与磁条的偏离程度,并计算出横移速度X进行车身姿态调整,实现纠偏; 如果车体发生的偏移情况为第一种与第二种情况的复合偏离情况,即既有旋转偏移,又有横向偏移的情况,则将得到的复合偏离情况拆解为第一种与第二种情况,再通过其各自对应的计算方式计算出相应的调整速度X与ω,同时进行横移和旋转调整,实现纠偏; 所述磁传感器为前、后两个磁传感器,分别安装在车体前端与后端;若车体正常行驶,没有任何偏移,则车体中心点在磁条路径上,同时车体中轴线与磁条路径之间没有夹角。
2.如权利要求1所述的方法,其特征在于,对于第一种情况,设前磁传感器的值为a,后磁传感器的值为b,前后磁传感器之间的距离为L,则计算前后磁传感器之间的数值差的绝对值|a_b I与和的一半(a+b) /2,并计算出车体中轴线与磁条之间的夹角α的三角函数tana=I a_b I/L,由此计算出夹角a,将夹角a乘以系数得到旋转速度ω,利用旋转速度ω进行车身姿态调整,实现纠偏,其中所述系数根据车体旋转到最偏程度时,按照夹角a越小旋转速度ω相应地越小的理论所进行的试验得到。
3.如权利要求2所述的方法,其特征在于,所述系数为0.02。
4.如权利要求2所述的方法,其特征在于,对于第二种情况,将前、后磁传感器的值之和的一半(a+b) /2减去前磁传感器或后磁传感器的中心值得到车体下方磁条的中点与车体中心点之间的距离d,然后计算横移速度x = 2.5d,利用横移速度X进行车身姿态调整,实现纠偏。
5.如权利要求4所述的方法,其特征在于,对于所述复合偏离情况,将前、后磁传感器的值之和的一半(a+b) /2减去前磁传感器或后磁传感器的中心值得到车体下方磁条的中点与车体中心点之间的距离d,然后计算横移速度X = y tana+d*2.5/cosa,利用x、y的复合速度进行车身姿态调整,实现纠偏,其中y为预设的车体前进速度。
CN201611058144.8A 2016-11-27 2016-11-27 全向移动agv导航纠偏方法 Active CN106527443B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611058144.8A CN106527443B (zh) 2016-11-27 2016-11-27 全向移动agv导航纠偏方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611058144.8A CN106527443B (zh) 2016-11-27 2016-11-27 全向移动agv导航纠偏方法

Publications (2)

Publication Number Publication Date
CN106527443A true CN106527443A (zh) 2017-03-22
CN106527443B CN106527443B (zh) 2019-06-18

Family

ID=58357092

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611058144.8A Active CN106527443B (zh) 2016-11-27 2016-11-27 全向移动agv导航纠偏方法

Country Status (1)

Country Link
CN (1) CN106527443B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106919176A (zh) * 2017-04-19 2017-07-04 无锡新创力工业设备有限公司 一种agv小车纠偏控制方法
CN107600221A (zh) * 2017-08-28 2018-01-19 电子科技大学 一种智能全向agv小车及其控制方法
CN108021134A (zh) * 2017-11-30 2018-05-11 厦门华蔚物联网科技有限公司 一种机器人纠偏系统及其控制方法
CN108120434A (zh) * 2017-12-20 2018-06-05 东风汽车集团有限公司 一种agv轨迹纠偏方法、系统及双导航系统
CN109399464A (zh) * 2018-12-29 2019-03-01 三海洋重工有限公司 龙门式起重机大车姿态控制方法及装置
CN111483623A (zh) * 2020-06-28 2020-08-04 蓝箭航天空间科技股份有限公司 一种航天运载器转运对接锁定控制系统和方法
WO2021035579A1 (en) * 2019-08-28 2021-03-04 Abb Schweiz Ag Apparatus and method for secondary positioning of automatic guided vehicle

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101984382A (zh) * 2010-10-15 2011-03-09 重庆市电力公司超高压局 利用机器人进行变电站设备智能巡检的方法
CN103246285A (zh) * 2012-02-10 2013-08-14 本田技研工业株式会社 无人行驶作业车的引导装置
CN103292806A (zh) * 2013-05-30 2013-09-11 成都四威高科技产业园有限公司 一种适合agv的磁导航系统和导航方法
CN103383570A (zh) * 2013-06-25 2013-11-06 天奇自动化工程股份有限公司 一种可全向移动的自动导航小车
WO2014043841A1 (zh) * 2012-09-19 2014-03-27 Zhang Yunan 履带式全方位移动平台
CN104149782A (zh) * 2014-07-31 2014-11-19 同济大学 一种基于磁导航的多传感器融合智能车的自动驾驶系统
CN104597905A (zh) * 2015-01-13 2015-05-06 广西大学 磁导航agv的路径跟踪方法
CN105242672A (zh) * 2015-11-13 2016-01-13 深圳市步科电气有限公司 可进行车体偏离角度调整的agv
CN105651286A (zh) * 2016-02-26 2016-06-08 中国科学院宁波材料技术与工程研究所 一种移动机器人视觉导航方法与系统、以及仓库系统
CN106123922A (zh) * 2016-07-25 2016-11-16 电子科技大学 基于比例微分调节的磁导航agv直行路线纠偏方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101984382A (zh) * 2010-10-15 2011-03-09 重庆市电力公司超高压局 利用机器人进行变电站设备智能巡检的方法
CN103246285A (zh) * 2012-02-10 2013-08-14 本田技研工业株式会社 无人行驶作业车的引导装置
WO2014043841A1 (zh) * 2012-09-19 2014-03-27 Zhang Yunan 履带式全方位移动平台
CN103292806A (zh) * 2013-05-30 2013-09-11 成都四威高科技产业园有限公司 一种适合agv的磁导航系统和导航方法
CN103383570A (zh) * 2013-06-25 2013-11-06 天奇自动化工程股份有限公司 一种可全向移动的自动导航小车
CN104149782A (zh) * 2014-07-31 2014-11-19 同济大学 一种基于磁导航的多传感器融合智能车的自动驾驶系统
CN104597905A (zh) * 2015-01-13 2015-05-06 广西大学 磁导航agv的路径跟踪方法
CN105242672A (zh) * 2015-11-13 2016-01-13 深圳市步科电气有限公司 可进行车体偏离角度调整的agv
CN105651286A (zh) * 2016-02-26 2016-06-08 中国科学院宁波材料技术与工程研究所 一种移动机器人视觉导航方法与系统、以及仓库系统
CN106123922A (zh) * 2016-07-25 2016-11-16 电子科技大学 基于比例微分调节的磁导航agv直行路线纠偏方法

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106919176A (zh) * 2017-04-19 2017-07-04 无锡新创力工业设备有限公司 一种agv小车纠偏控制方法
CN107600221A (zh) * 2017-08-28 2018-01-19 电子科技大学 一种智能全向agv小车及其控制方法
CN107600221B (zh) * 2017-08-28 2020-07-14 电子科技大学 一种智能全向agv小车及其控制方法
CN108021134A (zh) * 2017-11-30 2018-05-11 厦门华蔚物联网科技有限公司 一种机器人纠偏系统及其控制方法
CN108120434A (zh) * 2017-12-20 2018-06-05 东风汽车集团有限公司 一种agv轨迹纠偏方法、系统及双导航系统
CN109399464A (zh) * 2018-12-29 2019-03-01 三海洋重工有限公司 龙门式起重机大车姿态控制方法及装置
WO2021035579A1 (en) * 2019-08-28 2021-03-04 Abb Schweiz Ag Apparatus and method for secondary positioning of automatic guided vehicle
CN111483623A (zh) * 2020-06-28 2020-08-04 蓝箭航天空间科技股份有限公司 一种航天运载器转运对接锁定控制系统和方法

Also Published As

Publication number Publication date
CN106527443B (zh) 2019-06-18

Similar Documents

Publication Publication Date Title
CN106527443A (zh) 全向移动agv导航纠偏方法
CN107390691B (zh) 一种agv路径跟踪方法
CN106681317A (zh) Agv全向导航行驶方法
CN105764773B (zh) 用于控制车辆的方法
CN106020200B (zh) 采用轮毂电机驱动的agv小车及路径规划方法
CN105737838B (zh) 一种agv路径跟踪方法
CN104407615A (zh) 一种agv机器人导引偏差校正方法
CN106527432A (zh) 基于模糊算法和二维码自矫正的室内移动机器人协作系统
CN104597905B (zh) 磁导航agv的路径跟踪方法
Sabelhaus et al. Using continuous-curvature paths to generate feasible headland turn manoeuvres
CN107065887A (zh) 全向移动机器人通道内倒行导航方法
Reina et al. Odometry correction using visual slip angle estimation for planetary exploration rovers
CN107065873B (zh) 一种基于磁带导引agv的多曲率圆周路径循迹控制方法
CN107421545A (zh) 一种机器人的位置偏差检测方法、装置及机器人
CN110514220A (zh) 一种车辆里程校准方法、装置及存储介质
CN110347160A (zh) 一种基于双摄像头扫码的自动引导车及其导航方法
Juntao et al. Research of AGV positioning based on the two-dimensional Code Recognition Method
JP4269170B2 (ja) 軌道追従制御方法および装置
CN110320906A (zh) 一种基于麦克纳姆轮的四驱agv小车差速直线行驶姿态调整方法
US10643335B2 (en) Optical sensor for odometry tracking to determine trajectory of a wheel
CN104527780A (zh) 一种四轮独立转向车辆的转向控制方法
Kaneko et al. Monocular depth estimation by two-frame triangulation using flat surface constraints
CN110989571A (zh) 一种用于舵轮驱动型agv的循迹控制方法
CN107688338A (zh) 一种基于车尾磁传感器的磁导航无人车及其定位方法
Woo et al. Calibration of accelerometer using fuzzy inference system

Legal Events

Date Code Title Description
C06 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