CN108107883A - 一种基于磁带导引agv的多传感器信息融合定位方法 - Google Patents
一种基于磁带导引agv的多传感器信息融合定位方法 Download PDFInfo
- Publication number
- CN108107883A CN108107883A CN201711083914.9A CN201711083914A CN108107883A CN 108107883 A CN108107883 A CN 108107883A CN 201711083914 A CN201711083914 A CN 201711083914A CN 108107883 A CN108107883 A CN 108107883A
- Authority
- CN
- China
- Prior art keywords
- agv
- magnetic tape
- sensor
- tape
- magnetic
- 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 51
- 230000004927 fusion Effects 0.000 title claims abstract description 24
- 230000004807 localization Effects 0.000 title abstract 2
- 239000011159 matrix material Substances 0.000 claims description 34
- 230000008569 process Effects 0.000 claims description 13
- 238000005070 sampling Methods 0.000 claims description 9
- 238000001914 filtration Methods 0.000 claims description 7
- 239000011541 reaction mixture Substances 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 238000006073 displacement reaction Methods 0.000 claims description 5
- 238000009434 installation Methods 0.000 claims description 4
- 238000012546 transfer Methods 0.000 claims description 4
- 230000009471 action Effects 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000012937 correction Methods 0.000 abstract description 3
- 238000004519 manufacturing process Methods 0.000 description 9
- 239000000463 material Substances 0.000 description 3
- 238000012544 monitoring process Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000007500 overflow downdraw method Methods 0.000 description 2
- 235000013290 Sagittaria latifolia Nutrition 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 235000015246 common arrowhead Nutrition 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 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/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
- G05D1/0263—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic strips
-
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0272—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising means for registering the travel distance, e.g. revolutions of wheels
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种基于磁带导引AGV的多传感器信息融合定位方法,该方法首先建立的磁带导引AGV的循迹误差模型;确定了编码器与磁导引传感器的信号来源及特点,建立了磁带导引AGV的数据融合定位方法与定位修正策略。该发明在保证AGV循迹精度的情况下,提供一种对AGV内部传感器信息和导引传感器信息进行数据融合,且利用特殊磁带信号修正里程累计误差的方法,提高了AGV的定位精度,大大降低了系统的硬件成本。
Description
技术领域
本发明涉及移动机器人定位领域,尤其是一种基于磁带导引AGV的多传感器信息融合定位方法。
背景技术
近年来,随着经济社会的发展,市场需求已经开始转向多样化的方向,单品种大批量的生产模式已经日渐显现其弊端,定制化生产越来越受到消费者和生产者的青睐。如何在保持低成本高效率生产的前提下,提高生产的灵活性、多样性;缩短单品生产周期;在一个或多个设备发生故障下仍能维持生产,是急需解决的问题,柔性制造即在此基础上提出来了。
物料运输的时间成本是柔性制造系统效率进一步提高的瓶颈,因此缩短AGV系统运作的时间对整个物流系统起关键性作用,对实际工程应用有着巨大的影响,AGV运作流程主要包含装载、行驶、卸载、行驶四个过程。对于特定的AGV系统,物料的装卸载位置、AGV所能行驶的通道以及物料移载所需的时间是固定的。而单辆AGV在全局地图中的定位对AGV调度管理,系统运作效率及实时监控起着至关重要的作用,因此,AGV的行驶速度、任务调度及路径规划的优劣直接关系到整个AGV系统的运作。
磁带导引AGV以其高性价比、高可靠性和灵活性逐渐占据着低端市场主导地位。目前,大部分磁带导引AGV调度系统应用在低端制造业和应用场景相对固定的环境当中,而AGV的全局定位大多采用射频信号识别或里程计测程来实现,定位精度太过依赖外部信号,且大部分的AGV横向定位精度会随着时间的累积而不断减低,甚至出现定位脱轨的情况,这对于整个调度系统是致命的。为了提高磁带导引AGV的横向定位精度,针对AGV系统配置的磁导引传感器,
发明内容
为了解决磁带导引AGV已有定位方法中局部定位精度低、定位成本高且无法实现AGV的全局可定位及可监控等不足,本发明针对磁带导引AGV系统配置的传感器,并基于数据融合模型,提出了一种采用卡尔曼滤波算法对编码器和磁导引传感器的数据进行信息融合,并结合特殊磁带信号对AGV的定位精度进行进一步修正的定位方法。
本发明解决其技术问题所采用的技术方案是:
一种基于磁带导引AGV的多传感器信息融合定位方法,所述方法包括以下步骤:
步骤1)建立磁带导引AGV自动导引的循迹误差模型,根据AGV小车与导引路径的位置关系,对AGV循迹误差系统的偏差角度和横向偏差距离进行分析,记eθ为AGV小车行进方向相对于磁带中心线的偏差角度,ed为AGV质心相对于磁带中心线的横向偏差距离,磁带导引AGV的循迹误差系统表示为:
在AGV正常寻线运行的情况下,车体运行方向与磁带中心线的夹角始终保持小角度,因此,式(1)改写为:
其中,w(t)为AGV移动角速度,vc(t)为AGV质心移动线速度;
将式(2)改写成离散形式如下:
即
其中,T为系统采样时间,采样计数k∈N;
步骤2)确定AGV小车质心位置与磁导引传感器的安装位置,记磁导引传感器中心点与质心之间的距离为L;
步骤3)确定磁带导引路径以及特殊磁带信号的铺设方式;
步骤4)令AGV的系统状态变量xk=[eθ(k) ed(k)]T,控制输入量uk=Δv,Δv为AGV左右驱动轮的速度差,则可以采用卡尔曼滤波对AGV左右驱动轮编码器的里程计信息和横向偏差距离信息进行融合,系统状态方程为:
xk=Fxk-1+Buk (5)
其中,D为左右驱动轮轮距,F为作用在xk-1上的状态变换矩阵,B为作用在系统控制变量uk上的输入控制变换矩阵;
步骤5)由磁导引传感器和左右驱动轮的里程计信息提取的偏差数据作为滤波器的观测值,则得到系统的状态观测方程:
zk=Hxk (8)
其中, 分别为带有噪声的实际观测值;
步骤6)由左右驱动轮的里程计信息得到AGV沿磁带循迹移动的距离表示为:
其中,Δsl,Δsr分别为左右驱动轮的转动距离;
步骤7)在不同形式导引路径转换的节点处铺设横向磁带,以区别导引磁带路径,来修正AGV行进过程中里程计的累计误差。
进一步,所述步骤2)中,磁导引传感器安装在位于AGV小车行进方向的前端,磁导引传感器的数据值为传感器中心点偏离磁带中心线的距离值。
再进一步,所述步骤3)中,磁带导引路径的铺设方式采用直线和一定曲率的圆周形式,直线路径引导AGV小车进行距离,圆周路径引导AGV小车的方向转变。
更进一步,所述步骤3)中,特殊磁带信号采取垂直于导引路径的铺设方式,即在直线与圆周导引磁带的转换点处,导引磁带的左边或右边铺设垂直磁带,以区别磁导引传感器导引时的信号值。
进一步,所述步骤4)中,系统状态方程包含过程噪声Wk,符合均值为零,协方差矩阵为Qk的多元正态分布,Wk~N(0,Qk);
所述步骤4)和所述步骤5)中,在k时刻,对系统状态进行观测,系统的状态观测方程包含观测噪声Vk,符合均值为零,协方差矩阵为Rk的多元正态分布,Vk~N(0,Rk);
所述步骤4)和步骤5中,卡尔曼滤波的操作过程分为两个阶段:预测,利用上一阶段的状态估计值,作出对当前状态的估计;更新,使用当前状态的观测值对预测阶段的预测值进行优化,获得一个对系统当前状态更加精确的估计;
预测系统状态:
式(11)中,是根据上一阶段的最优估计结果以及最近一次的控制输入uk-1对现在的系统状态的估计;
预测协方差矩阵:
式(12)中,Pk-1|k-1是对应的协方差矩阵,Pk|k-1是对应的协方差矩阵,Qk为系统动态噪声的协方差矩阵;
以上为卡尔曼滤波器对系统状态的预测阶段,下面为滤波器根据实际观测值对预测数据进行更新的阶段:
式(13)中,为测量余量,是真实观测值zk与预测系统状态估计观测的差值;
式(14)中,Sk为测量余量的协方差矩阵,包含了预测阶段误差的传递值和观测噪声协方差矩阵Rk;
式(15)中,Kk是对测量余量的权重估计,即卡尔曼增益;
式(16)中,I为单位矩阵,Pk|k为系统协方差矩阵Pk|k-1的更新,以便在下一次状态估计中使用;
以上即为卡尔曼滤波算法的基本流程,根据公式(11)~(16)采用计算机容易实现滤波器的自回归计算。
更进一步,步骤4)和步骤5)中,采用的编码器是AGV的内部传感器,其工作稳定抗干扰,数据采集精度高,在AGV稳定运行车轮无滑移的前提下,得到车体精确的位移数据,但其误差会随时间积累;磁导引传感器属于外部传感器,直接得到其中心点与导引磁带中心线的偏差距离信息,其精度受采样频率和外界干扰磁场的限制。
所述步骤6)中,两轮差速移动机器人的里程计模型可以得到AGV行进里程信息。
进一步,所述步骤7)中,由于里程计信息的累积误差,故必须定时修正其误差,磁导引传感器的信号采集特点决定了可以铺设横向磁带来作定点标识。
本发明的技术构思为:采用传感器信息融合技术,设计了卡尔曼滤波器的定位方法,并且在综合比较了磁导引传感器、编码器各自的数据特点后,对滤波结果进行了进一步的融合处理,提高了AGV相对于磁带的横向定位精度,并且在此基础上,采用布置特殊磁带信号点的方法,对AGV的纵向定位精度进行修正,综合以上方法,实现了AGV的全局可定位和可监控。
本发明的有益效果主要表现在:针对固定导引路径的AGV定位问题,由于过于依靠外部传感器而导致定位精度易受外界环境影响,且成本相对较高,以及无法准确定位AGV的站点、节点等位置信息等不足,针对以上存在的问题,本发明提供一种对AGV内部传感器信息和导引传感器信息进行数据融合,且利用特殊磁带信号修正里程累计误差的方法,解决了固定路径导引AGV的相对定位问题。本专利提供的定位方法将导引传感器用于定位和识别站点等信息,有效且充分地扩展了已有传感器的用途,降低了系统的硬件成本。相比传统的利用外界的射频信号、行程开关、视觉等方法来定位,本发明采用数据融合的方法解决AGV质心相对于磁带中心线的定位偏差问题,利用特殊磁带信号解决AGV的运行里程累计误差问题,提高了相对定位的精度,且大大降低了系统的硬件成本。
附图说明:
图1是磁带导引AGV的循迹示意图,便于得到小车的循迹误差模型;
图2是磁带导引AGV系统状态量与磁导引传感器偏差关系示意图,便于刻画系统输出变量;
图3是特殊磁带信号的集中铺设方式,便于得到AGV的站点信息;
图4是AGV的数据融合模型。
具体实施方式
下面结合附图对本发明作进一步描述。
参照图1~图4,一种基于磁带导引AGV的多传感器信息融合定位方法,
所述方法包括以下步骤:
步骤1)建立磁带导引AGV自动导引的循迹误差模型,根据AGV小车与导引路径的位置关系,对AGV循迹误差系统的偏差角度和横向偏差距离进行分析,记eθ为AGV小车行进方向相对于磁带中心线的偏差角度,ed为AGV质心相对于磁带中心线的横向偏差距离,磁带导引AGV的循迹误差系统表示为:
在AGV正常寻线运行的情况下,车体运行方向与磁带中心线的夹角始终保持小角度,因此,式(1)可改写为:
其中,w(t)为AGV移动角速度,vc(t)为AGV质心移动线速度;
将式(2)改写成离散形式如下:
即
其中,T为系统采样时间,采样计数k∈N;
步骤2)确定AGV小车质心位置与磁导引传感器的安装位置,记磁导引传感器中心点与质心之间的距离为L;
步骤3)确定磁带导引路径以及特殊磁带信号的铺设方式;
步骤4)令AGV的系统状态变量xk=[eθ(k)ed(k)]T,控制输入量uk=Δv,Δv为AGV左右驱动轮的速度差,则可以采用卡尔曼滤波对AGV左右驱动轮编码器的里程计信息和横向偏差距离信息进行融合,系统状态方程为:
xk=Fxk-1+Buk (5)
其中,D为左右驱动轮轮距,F为作用在xk-1上的状态变换矩阵,B为作用在系统控制变量uk上的输入控制变换矩阵;
步骤5)由磁导引传感器和左右驱动轮的里程计信息提取的偏差数据作为滤波器的观测值,则得到系统的状态观测方程:
zk=Hxk (8)
其中, 分别为带有噪声的实际观测值;
步骤6)由左右驱动轮的里程计信息得到AGV沿磁带循迹移动的距离表示为:
其中,Δsl,Δsr分别为左右驱动轮的转动距离;
步骤7)在不同形式导引路径转换的节点处铺设横向磁带,以区别导引磁带路径,来修正AGV行进过程中里程计的累计误差;
进一步,所述步骤2)中,磁导引传感器一般安装在位于AGV小车行进方向的前端,磁导引传感器的数据值为传感器中心点偏离磁带中心线的距离值;
进一步,所述步骤3)中,磁带导引路径的铺设方式采用直线和一定曲率的圆周形式,直线路径引导AGV小车进行距离,圆周路径引导AGV小车的方向转变;
更进一步,所述步骤3)中,特殊磁带信号采取垂直于导引路径的铺设方式,即在直线与圆周导引磁带的转换点处,导引磁带的左边或右边铺设垂直磁带,以区别磁导引传感器导引时的信号值;
进一步,所述步骤4)中,系统状态方程包含过程噪声Wk,符合均值为零,协方差矩阵为Qk的多元正态分布,Wk~N(0,Qk);
结合步骤4),所述步骤5)中,在k时刻,对系统状态进行观测,系统的状态观测方程包含观测噪声Vk,符合均值为零,协方差矩阵为Rk的多元正态分布,Vk~N(0,Rk);
针对步骤4)和步骤5),卡尔曼滤波的操作过程分为两个阶段:预测,利用上一阶段的状态估计值,作出对当前状态的估计;更新,使用当前状态的观测值对预测阶段的预测值进行优化,获得一个对系统当前状态更加精确的估计;
预测系统状态:
式(11)中,是根据上一阶段的最优估计结果以及最近一次的控制输入uk-1对现在的系统状态的估计;
预测协方差矩阵:
式(12)中,Pk-1|k-1是对应的协方差矩阵,Pk|k-1是对应的协方差矩阵,Qk为系统动态噪声的协方差矩阵;
以上为卡尔曼滤波器对系统状态的预测阶段,下面为滤波器根据实际观测值对预测数据进行更新的阶段:
式(13)中,为测量余量,是真实观测值zk与预测系统状态估计观测的差值;
式(14)中,Sk为测量余量的协方差矩阵,包含了预测阶段误差的传递值和观测噪声协方差矩阵Rk;
式(15)中,Kk是对测量余量的权重估计,即卡尔曼增益;
式(16)中,I为单位矩阵,Pk|k为系统协方差矩阵Pk|k-1的更新,以便在下一次状态估计中使用;
以上即为卡尔曼滤波算法的基本流程,根据公式(11)~(16)采用计算机容易实现滤波器的自回归计算;
更进一步,步骤4)和步骤5)中,采用的编码器是AGV的内部传感器,其工作稳定抗干扰,数据采集精度高,在AGV稳定运行车轮无滑移的前提下,可以得到车体精确的位移数据,但其误差会随时间积累;磁导引传感器属于外部传感器,可直接得到其中心点与导引磁带中心线的偏差距离信息,其精度受采样频率和外界干扰磁场的限制;
所述步骤6)中,两轮差速移动机器人的里程计模型可以得到AGV行进里程信息;
进一步,所述步骤7)中,由于里程计信息的累积误差,故必须定时修正其误差,磁导引传感器的信号采集特点决定了可以铺设横向磁带来作定点标识。
本实施例的基于磁带导引AGV的多传感器信息融合定位方法,所述方法包括以下步骤:
步骤1)以四轮小车为研究对象,两前轮作为驱动轮,实现差速转向,两后轮作为从动轮,起支撑作用。从图1中得到磁带导引AGV的循迹误差模型,为选择器控制方法以及具体设计其控制器提供了依据,同时也为后续的信息融合提供了数学依据。
步骤2)图2给出了磁带导引AGV循迹的最一般姿态,磁导引传感器得出的物理量为磁导引传感器中心点与磁带中心线的偏差距离E,由此,可以计算出AGV质心相对于磁带中心线的偏差距离为:
ed=E cos eθ-L sin eθ (17)
其中,θ0为AGV的初始偏差角度;
步骤3)对于特殊磁带信号的铺设方式有三种情形,如图3所示,第一种是铺设在AGV行进方向上的左侧,第二种是右侧,第三种是左右两侧都铺设,这样就有三种特殊磁带信号,有利于在AGV循迹过程中不同更多站点信号的检测与里程误差的修正;
步骤4)对左右驱动轮编码器信号进行变换补偿后得到驱动轮的线速度,磁导引传感器信号经过处理后得到车体与磁带导引线的偏差以及到达站点的位置信息,通过采用卡尔曼滤波融合的方法得到AGV车体方位与预定线路偏差的最优估计;而根据特殊磁带信号的信息以及预先存储的路径数据库预知了站点信息,结合特殊磁带信息和磁导引传感器提取到的站点位置,进而对AGV当前的进行累计里程误差进行进一步的整合修正。
如图1所示,磁带导引AGV的各参数表示清晰,并且在全局坐标系中给定AGV的最一般姿态,对其进行动态分析,得到磁带导引AGV的循迹误差模型,图中各符号表示为:O′为AGV两驱动轮轮轴中心即质心;D为AGV两驱动轮轮距;νl为AGV左驱动轮移动线速度;νr为AGV右驱动轮移动线速度;νc为AGV质心移动线速度;ed为AGV质心与磁带轨迹中心线的横向偏差距离;eθ为AGV质心行进方向与磁带轨迹中心线的偏差角度;1为铺设磁带轨迹,箭头表示小车行进方向;
如图2所示,为移动机器人在循迹过程中如何通过磁导引传感器采集的信息来刻画控制系统的输出变量,且输出变量ed只与当前时刻的E和eθ相关。图中各符号表示为:O′为AGV两驱动轮轮轴中心即质心;D为AGV两驱动轮轮距;1为铺设磁带轨迹,箭头表示小车行进方向;2为磁导引传感器;L为磁导引传感器安装位置相对于AGV质心的垂直距离;E为磁导引传感器中心点相对于磁带中心线的偏差距离;M为磁导引传感器的中心点;ed为AGV质心与磁带轨迹中心线的横向偏差距离;eθ为AGV质心行进方向与磁带轨迹中心线的偏差角度;
如图3所示,为磁带导引系统中特殊磁带信号的铺设方式,充分扩展了磁带的作用。图中各符号表示为:4为铺设磁带轨迹,箭头表示小车行进方向;1为特殊磁带铺设在AGV行进方向上的右侧;2为特殊磁带铺设在AGV行进方向上的左侧;3为特殊磁带铺设在AGV行进方向上的左右两侧;
如图3所示,为AGV数据融合模型,给出了磁带导引AGV在整个循迹过程中定位方法。图中各符号表示为:1为信号源;2为数据融合定位与定位修正;3为决策控制。
Claims (8)
1.一种基于磁带导引AGV的多传感器信息融合定位方法,其特征在于:所述方法包括以下步骤:
步骤1)建立磁带导引AGV自动导引的循迹误差模型,根据AGV小车与导引路径的位置关系,对AGV循迹误差系统的偏差角度和横向偏差距离进行分析,记eθ为AGV小车行进方向相对于磁带中心线的偏差角度,ed为AGV质心相对于磁带中心线的横向偏差距离,磁带导引AGV的循迹误差系统表示为:
在AGV正常寻线运行的情况下,车体运行方向与磁带中心线的夹角始终保持小角度,因此,式(1)改写为:
其中,w(t)为AGV移动角速度,vc(t)为AGV质心移动线速度;
将式(2)改写成离散形式如下:
即
其中,T为系统采样时间,采样计数k∈N;
步骤2)确定AGV小车质心位置与磁导引传感器的安装位置,记磁导引传感器中心点与质心之间的距离为L;
步骤3)确定磁带导引路径以及特殊磁带信号的铺设方式;
步骤4)令AGV的系统状态变量xk=[eθ(k) ed(k)]T,控制输入量uk=Δv,Δv为AGV左右驱动轮的速度差,则采用卡尔曼滤波对AGV左右驱动轮编码器的里程计信息和横向偏差距离信息进行融合,系统状态方程为:
xk=Fxk-1+Buk (5)
其中,D为左右驱动轮轮距,F为作用在xk-1上的状态变换矩阵,B为作用在系统控制变量uk上的输入控制变换矩阵;
步骤5)由磁导引传感器和左右驱动轮的里程计信息提取的偏差数据作为滤波器的观测值,则得到系统的状态观测方程:
zk=Hxk (8)
其中,分别为带有噪声的实际观测值;
步骤6)由左右驱动轮的里程计信息得到AGV沿磁带循迹移动的距离表示为:
其中,Δsl,Δsr分别为左右驱动轮的转动距离;
步骤7)在不同形式导引路径转换的节点处铺设横向磁带,以区别导引磁带路径,来修正AGV行进过程中里程计的累计误差。
2.如权利要求1所述的一种基于磁带导引AGV的多传感器信息融合定位方法,其特征在于:所述步骤2)中,磁导引传感器安装在位于AGV小车行进方向的前端,磁导引传感器的数据值为传感器中心点偏离磁带中心线的距离值。
3.如权利要求1或2所述的一种基于磁带导引AGV的多传感器信息融合定位方法,其特征在于:所述步骤3)中,磁带导引路径的铺设方式采用直线和一定曲率的圆周形式,直线路径引导AGV小车进行距离,圆周路径引导AGV小车的方向转变。
4.如权利要求1或2所述的一种基于磁带导引AGV的多传感器信息融合定位方法,其特征在于:所述步骤3)中,特殊磁带信号采取垂直于导引路径的铺设方式,即在直线与圆周导引磁带的转换点处,导引磁带的左边或右边铺设垂直磁带,以区别磁导引传感器导引时的信号值。
5.如权利要求1或2所述的一种基于磁带导引AGV的多传感器信息融合定位方法,其特征在于:所述步骤4)和步骤5)中,卡尔曼滤波的操作过程分为两个阶段:预测,利用上一阶段的状态估计值,作出对当前状态的估计;更新,使用当前状态的观测值对预测阶段的预测值进行优化,获得一个对系统当前状态更加精确的估计;
预测系统状态:
式(11)中,是根据上一阶段的最优估计结果以及最近一次的控制输入uk-1对现在的系统状态的估计;
预测协方差矩阵:
式(12)中,Pk-1|k-1是对应的协方差矩阵,Pk|k-1是对应的协方差矩阵,Qk为系统动态噪声的协方差矩阵;
以上为卡尔曼滤波器对系统状态的预测阶段,下面为滤波器根据实际观测值对预测数据进行更新的阶段:
式(13)中,为测量余量,是真实观测值zk与预测系统状态估计观测的差值;
式(14)中,Sk为测量余量的协方差矩阵,包含了预测阶段误差的传递值和观测噪声协方差矩阵Rk;
式(15)中,Kk是对测量余量的权重估计,即卡尔曼增益;
式(16)中,I为单位矩阵,Pk|k为系统协方差矩阵Pk|k-1的更新,以便在下一次状态估计中使用。
6.如权利要求1或2所述的一种基于磁带导引AGV的多传感器信息融合定位方法,其特征在于:所述步骤4)和步骤5)中,采用的编码器是AGV的内部传感器,其工作稳定抗干扰,数据采集精度高,在AGV稳定运行车轮无滑移的前提下,得到车体精确的位移数据,但其误差会随时间积累;磁导引传感器属于外部传感器,直接得到其中心点与导引磁带中心线的偏差距离信息,其精度受采样频。
7.如权利要求1或2所述的一种基于磁带导引AGV的多传感器信息融合定位方法,其特征在于:所述步骤6)中,两轮差速移动机器人的里程计模型得到AGV行进里程信息。
8.如权利要求1或2所述的一种基于磁带导引AGV的多传感器信息融合定位方法,其特征在于:所述步骤7)中,铺设横向磁带来作定点标识。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711083914.9A CN108107883B (zh) | 2017-11-07 | 2017-11-07 | 一种基于磁带导引agv的多传感器信息融合定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711083914.9A CN108107883B (zh) | 2017-11-07 | 2017-11-07 | 一种基于磁带导引agv的多传感器信息融合定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108107883A true CN108107883A (zh) | 2018-06-01 |
CN108107883B CN108107883B (zh) | 2020-10-30 |
Family
ID=62206705
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711083914.9A Active CN108107883B (zh) | 2017-11-07 | 2017-11-07 | 一种基于磁带导引agv的多传感器信息融合定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108107883B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110398253A (zh) * | 2019-07-22 | 2019-11-01 | 北京特种机械研究所 | Agv导航调度实现系统及agv控制系统 |
CN110398965A (zh) * | 2019-07-22 | 2019-11-01 | 北京特种机械研究所 | 一种基于有迹导航地图设计的agv导航调度方法 |
CN110789606A (zh) * | 2019-10-16 | 2020-02-14 | 合肥搬易通科技发展有限公司 | 基于全轮速度检测控制行驶方向及位置的自动导向方法及其叉车系统 |
CN110849349A (zh) * | 2019-10-18 | 2020-02-28 | 浙江天尚元科技有限公司 | 一种基于磁传感器与轮式里程计融合定位方法 |
CN111361639A (zh) * | 2020-04-01 | 2020-07-03 | 苏州先锋物流装备科技有限公司 | 一种叉车用自动导航系统及方法 |
CN111474933A (zh) * | 2020-04-24 | 2020-07-31 | 合肥工业大学 | 一种磁导引agv的自动纠偏控制方法 |
CN111505935A (zh) * | 2020-04-30 | 2020-08-07 | 内蒙古工业大学 | 一种自动引导车控制方法和系统 |
CN113022449A (zh) * | 2021-04-02 | 2021-06-25 | 山东菁华环境科技有限公司 | 一种用于车辆安全行驶的电子虚拟护栏警示系统 |
CN115321434A (zh) * | 2022-08-05 | 2022-11-11 | 浙江华睿科技股份有限公司 | 一种叉车的转向控制方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3040680A1 (en) * | 2014-12-30 | 2016-07-06 | Northrop Grumman Systems Corporation | Magnetic anomaly tracking for an inertial navigation system |
CN106444765A (zh) * | 2016-10-21 | 2017-02-22 | 广东工业大学 | 一种agv、基于视觉的agv导航方法及其系统 |
CN106843214A (zh) * | 2017-02-13 | 2017-06-13 | 浙江工业大学 | 一种基于自抗扰控制的磁带导引agv循迹控制方法 |
CN107065873A (zh) * | 2017-04-13 | 2017-08-18 | 浙江工业大学 | 一种基于磁带导引agv的多曲率圆周路径循迹控制方法 |
CN107121981A (zh) * | 2017-04-20 | 2017-09-01 | 杭州南江机器人股份有限公司 | 一种基于视觉的agv巡线导航和定位方法 |
-
2017
- 2017-11-07 CN CN201711083914.9A patent/CN108107883B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3040680A1 (en) * | 2014-12-30 | 2016-07-06 | Northrop Grumman Systems Corporation | Magnetic anomaly tracking for an inertial navigation system |
CN106444765A (zh) * | 2016-10-21 | 2017-02-22 | 广东工业大学 | 一种agv、基于视觉的agv导航方法及其系统 |
CN106843214A (zh) * | 2017-02-13 | 2017-06-13 | 浙江工业大学 | 一种基于自抗扰控制的磁带导引agv循迹控制方法 |
CN107065873A (zh) * | 2017-04-13 | 2017-08-18 | 浙江工业大学 | 一种基于磁带导引agv的多曲率圆周路径循迹控制方法 |
CN107121981A (zh) * | 2017-04-20 | 2017-09-01 | 杭州南江机器人股份有限公司 | 一种基于视觉的agv巡线导航和定位方法 |
Non-Patent Citations (2)
Title |
---|
ZHANG, WEN-AN等: "Stability analysis and stabilization of aperiodic sampled-data systems based on a switched system approach", 《JOURNAL OF THE FRANKLIN INSTITUTE-ENGINEERING AND APPLIED MATHEMATICS》 * |
卢超月等: "STM32的磁导航自主导引车通用驱动器设计", 《单片机与嵌入式系统应用》 * |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110398965A (zh) * | 2019-07-22 | 2019-11-01 | 北京特种机械研究所 | 一种基于有迹导航地图设计的agv导航调度方法 |
CN110398253A (zh) * | 2019-07-22 | 2019-11-01 | 北京特种机械研究所 | Agv导航调度实现系统及agv控制系统 |
CN110789606A (zh) * | 2019-10-16 | 2020-02-14 | 合肥搬易通科技发展有限公司 | 基于全轮速度检测控制行驶方向及位置的自动导向方法及其叉车系统 |
CN110849349A (zh) * | 2019-10-18 | 2020-02-28 | 浙江天尚元科技有限公司 | 一种基于磁传感器与轮式里程计融合定位方法 |
CN110849349B (zh) * | 2019-10-18 | 2023-04-07 | 浙江天尚元科技有限公司 | 一种基于磁传感器与轮式里程计融合定位方法 |
CN111361639A (zh) * | 2020-04-01 | 2020-07-03 | 苏州先锋物流装备科技有限公司 | 一种叉车用自动导航系统及方法 |
CN111474933B (zh) * | 2020-04-24 | 2022-03-15 | 合肥工业大学 | 一种磁导引agv的自动纠偏控制方法 |
CN111474933A (zh) * | 2020-04-24 | 2020-07-31 | 合肥工业大学 | 一种磁导引agv的自动纠偏控制方法 |
CN111505935A (zh) * | 2020-04-30 | 2020-08-07 | 内蒙古工业大学 | 一种自动引导车控制方法和系统 |
CN111505935B (zh) * | 2020-04-30 | 2022-10-18 | 内蒙古工业大学 | 一种自动引导车控制方法和系统 |
CN113022449A (zh) * | 2021-04-02 | 2021-06-25 | 山东菁华环境科技有限公司 | 一种用于车辆安全行驶的电子虚拟护栏警示系统 |
CN115321434A (zh) * | 2022-08-05 | 2022-11-11 | 浙江华睿科技股份有限公司 | 一种叉车的转向控制方法及装置 |
CN115321434B (zh) * | 2022-08-05 | 2023-12-26 | 浙江华睿科技股份有限公司 | 一种叉车的转向控制方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN108107883B (zh) | 2020-10-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108107883B (zh) | 一种基于磁带导引agv的多传感器信息融合定位方法 | |
CN106843214B (zh) | 一种基于自抗扰控制的磁带导引agv循迹控制方法 | |
CN106643800B (zh) | 航向角误差校准方法及自动导航驾驶系统 | |
CN107085938B (zh) | 基于车道线与gps跟随的智能驾驶局部轨迹容错规划方法 | |
US7756615B2 (en) | Traffic management system for a passageway environment | |
CN107272008A (zh) | 一种带惯性补偿的agv激光导航系统 | |
CN102662401B (zh) | 一种基于电磁感应循迹的导航系统 | |
CN205950750U (zh) | 基于惯性导航的变电站巡检机器人导航控制系统 | |
CN112628524B (zh) | 一种基于拐弯角的小径管道机器人高精度定位方法 | |
CN111238471B (zh) | 一种适用于农业机械直线导航的侧滑角度估计方法及估计器 | |
CN108693872A (zh) | 自动导引运输车的导航方法、系统和自动导引运输车 | |
CN104515527A (zh) | 一种无gps信号环境下的抗粗差组合导航方法 | |
CN105091909A (zh) | 一种基于gps速度的机车轮径自动校正方法 | |
JP5730068B2 (ja) | 鉄道車両の位置検出装置および位置検出方法 | |
CN108646750A (zh) | 基于uwb非基站便捷式工厂agv跟随方法 | |
CN108196545B (zh) | 采用自抗扰控制技术的agv磁导航控制方法 | |
CN103631260A (zh) | 运输载具及其控制方法 | |
CN116380055A (zh) | 一种综采工作面有轨式巡检机器人的自主定位方法 | |
CN114281081B (zh) | 地铁车辆巡检机器人的导航系统和导航方法、机器人 | |
Jiao et al. | A sliding parameter estimation method based on UKF for agricultural tracked robot | |
CN115366942A (zh) | 一种基于双传感器感知时延的地铁里程定位方法 | |
JP5773780B2 (ja) | 鉄道車両の位置検出装置および位置検出方法 | |
Bouchama et al. | Observer-based Robust Train Speed Estimation Subject to Wheel-Rail Adhesion Faults | |
CN114115266B (zh) | Agv磁寻迹偏移量计算方法、存储介质及agv | |
CN109916403A (zh) | 一种用于agv小车的短时精确定位的装置及方法 |
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 |