基于多传感器数据融合AGV机器人定位技术探究.docVIP

基于多传感器数据融合AGV机器人定位技术探究 　　【摘 要】本文分析了AGV机器人在运行过程中产生的定位误差的原因，并对定位误差进行分析。提出了一种基于卡尔曼滤波理论理论的AGV机器人多传感器融合算法 【关键词】多传感器数据融合；AGV 0 引言 随着柔性制造系统的普及，智能AGV机器人作为工件载具，广泛应用于制造业、仓储业、危险场所以及特种行业。AGV机器人自主行驶的先决条件就是有效的定位，而AGV在移动过程中的定位，又是一个更为困难的问题。如果AGV不能准确的获取当前的位置，无法和工作环境位置模型进行正确比对。就不能按照规划好的线路行进，不能准确按照方向行走，不能在准确的位置进行转向或做业。本文通过多传感器融合技术来帮助AGV定位，从而控制AGV准确按照轨迹运动 1 AGV机器人定位误差产生的原因 现在AGV机器人定位主要依赖于与车轮连接的广电编码器。一般采用增量式光电编码器，使用单片机组成积算器，把机器人轮上的位移量进行积分。但是由于传动、打滑等因素，会导致累积误差的出现。这些影响因素有可能是来自于系统本身特性，也有可能由外部环境变化而产生的。所以，误差可以分为系统误差和非系统误差两类 1.1 AGV定位的系统误差是由传动系统、计量系统本身产生的，是固定的。系统误差的产生，多是由于组成系统的元件本身的误差积累造成的。如：驱动轮的直径不可能完全一致；驱动轮转动的圆周误差；传动带本身误差；驱动轮轴线的跳动；光电编码器本身误差；积算器采样误差等等。系统误差可以测量，并且可以进行补偿 1.2 非系统误差 非系统误差是由于外部环境的变化作用于AGV系统的扰动。如：由于地面因素造成的轮胎打滑；地面崎岖不平，造成的位移偏差；AGV转向速度过快造成的横向加速度；由于突出障碍物造成AGV轮胎转动受阻等等因素，使编码器测量系统积算得到的位置与实际位置造成偏差 2 建立AGV运动模型 由于AGV工作环境结构布局以及服务设备分布布局信息需要。需要建立地理坐标系和AGV车身坐标系，来对在对AGV机器人的环境信息进行描述 地理坐标系：描述AGV机器人所运行的平面环境的坐标系，一般选择AGV的出发点为坐标系原点o，选择正方向后建立与地图相似的X，Y轴坐标 AGV车身坐标系：以车身作为参考物。通常把AGV车体上某点（如几何中心）作为原点o’。X’轴一般选择车头指向方向，垂直车头方向轴为Y’轴。由于AGV车体的运动，所以 AGV车身坐标系是运动坐标系，随着车身的运行做水平平移或者角度旋转 3 AGV定位误差模型 由于AGV机器人的差动驱动结构原因，以及AGV的积算式定位原理，机器人的位置和姿态可以用绝对坐标值以及运动方向角度组成的向量表示： A=XY？兹 对于AGV机器人，运动误差来源于地理坐标系与车体运动坐标系之差 ？驻A=？驻X-？驻X’？驻Y-？驻Y’？驻？兹-？驻a？兹’ 由于车体运动坐标系一般是使用AGVA机器人左右轮广电编码器进行累计得到，包含运动姿态也是由左右轮差动得到。因此可以从一个出发点位置开始，并将运动进行积分予以估计。行走距离的增量，可以依靠固定采样间隙？驻t 的离散系统 设？驻l为AGV机器人移动量，也就是左右轮移动平均量。则更新后的位置A’ A’=x’y’？兹’+？驻l cos（？兹+？驻？兹/2）？驻l sin（？兹+？驻？兹/2） ？驻？兹 4 AGV机器人位置计算用传感器选择 AGV机器人的定位问题是非常重要的。AGV机器人移动中的定位不仅仅关于到AGV机器人的线路规划，还直接决定了后续的做业，以及多台AGV之间的调度问题。因此选择传感器要考虑AGV移动中的定位和定位精度，特别是高速直线运动和转弯是造成的偏差 因此，我们出于技术成熟、模块尺寸、与原有设备匹配情况、成本等多方面考虑后，计划增加一些传感器以提高AGV精度。为了解决AGV机器人在直线加速、减速造成的累积误差，增加了加速度传感器，用于修正因加速度造成的累积误差。为了解决机器人在转向的时候产生的角度偏差，增加了电子陀螺仪模块和电子罗盘模块，用于修正角度积累误差。为了避免电子罗盘在复杂的工业电磁环境下失效，同时使用电子陀螺仪和电子罗盘，利用陀螺仪惯性定位，提高定位精度。由于多种传感器的采用，AGV机器人的定位将面临着一个传感器信息融合的问题，因此需要采用传感器融合算法，使用多传感器来提高定位精度 多传感器信息融合的本质是对多源不确定信息的分析和综合，是一个复杂的过程。我们需要处理的光电编码器，实时电子罗盘、陀螺仪、加速度计实时控制系统和其他传感器数据的快速处理数据，尽量简化计算，和尽量少占用MCUDE的数据存储空间。处于以上考虑，卡尔曼滤波理论适用AG