基于惯性具有姿态自检功能的磁导航AGV研究-AGV吧

第一章绪论

1.1课题研究的背景及意义

1.2国内外AGV研究发展现状

1.3惯性导航与信息融合技术

1.4本论文研究内容

第二章 AGV运动控制

2.1AGV差速驱动运动学模型

本文的研宄的磁导航AGV小车为六轮式结构，其中车体前排和后排各对称布置一组万向轮，它们不带动力驱动，这四个万向轮只起到支撑车体的作用。车体的运动由位于车体中部的驱动单元进行驱动，驱动单元通过减震装置柔性连接于车体骨架，这种设计减小了AGV转弯半径，并在越障时能有效避免驱动轮出现浮空不着地的情况。驱动单元中的动力源为两个８６系列步进电机，通过控制两个电机的转速使它们之间构成不同的转速差？然后驱动与它们固连的两驱动轮转动即可实现在不同半径的弯道上进行行驶或保持直线行驶。

在AGV的实际工作运行当中，由于AGV是非完整约束系统以及其轮胎与地面接触时的非线性特性，要得到其精确运动学数学模型十分困难。为构建AGV运动学模型须要做如下简化和假设：

（1）车轮在二维的水平路面上低速运行，轮子不变形；

（2）轮子不发生与轮轴轴向平行的横向滑动；

（3）轮面与地面始终垂直并保持点接触，即假设车轮运行时不发生形变从而进行滑动，而只发生绕轮轴纯滚动；

（4）两驱动轮大小一致并且始终处于同一轴线上，轴线同平台的前进方向相垂直；

由于万向轮无动力驱动，只是跟随车体运动，且偏心式万向轮当受到正交于轮子平面的运动影响时，横向滑动会被万向轮所产生的等效且相反的绕自身垂直轴的转动所平衡，其没有对AGV施加任何实际的运动学约束。因此建立运动学模型时可以将AGV简化为两轮式结构，仅考虑两驱动轮运动情况。简化后的模型如图2-1所示，图中X－Y为全局坐标系，为车体局部坐标系，取左右驱动轮的中心连线的中点C作为局部坐标系点，且将其作为AGV车体在全局坐标系中的位姿参考点，则小车的位姿可表示为P＝［Xc，Yc，θ］，Xc，Yc为C点在全局坐标系中的标，θ为AGV运动方向与全局坐标系的夹角。ｖ，ω分别为质心C点的速度和车体自转角速度，L为两驱动轮轮距。两驱动轮在全局坐标系中坐标为（X1，Y1）和（X2，Y2），则根据两驱动轮轮距不变，以及AGV只做与驱动轮中心连线相垂直方向的运动而不做横向滑移运动，可得到两约束方程如下：

（X1－X2）²＋（Y1－Y2）²=L²

Xsinθ-Ysinθ=0