APP下载

全向AGV的优化互补滤波姿态解算

2021-06-08牛秦玉蒙松畅科剑李雯

机械科学与技术 2021年5期

牛秦玉,蒙松,畅科剑,李雯

(西安科技大学 机械工程学院,西安 710054)

随着近年来无人化工厂物流业和仓储业的蓬勃发展,使得自动导引车(Automated guided vehicles,AGV)的市场需求量急剧上升。在现代制造加工系统中,物流传输时间占整个产品生产总时间的80%~90%,生产物料的传输与存储费用,占整个零部件加工费用的30%~40%[1-2]。缩短AGV在物流上传输时间,在降低整个物流过程传输和储存的费用上,起到了重要的作用。由于全向AGV在工厂和仓库中,实际用于物流运输,则必须保证AGV小车能够在各个工位之间线性行驶,通常是由上位机中的ROS系统中的导航功能包完成基于AGV小车自身位置到目标点的直线最优路径规划,将直线路径解析成一系列速度指令,由AGV中的下位机接收,并控制小车底盘完成规划的路径行驶,同时底盘传回由姿态传感器采集的姿态数据,形成闭环姿态控制。则必须研究基于全向AGV的姿态解算问题,得到精确的AGV小车底盘姿态解算数据,完成对整个小车的姿态控制,从而实现基于SLAM导航的四轮独立驱动的Mecanum轮的AGV线性行驶。

AGV小车的运行姿态是小车进行SLAM建图和自动导航所需要获取的传感器信息中最重要的部分,其姿态数据的精确性直接影响姿态控制的精度和定位精度。姿态描述参数主要包括余弦矩阵、欧拉角和姿态四元数[3]。姿态四元数具有计算量小、运算快、全姿态、同时能避开“万向节死锁问题”等优点,在姿态控制系统中得到了广泛的应用。但是四元数属于旋转矢量,且四个变量不独立。……

登录APP查看全文