AGV运动学模型

1、第二章自动导引小车运动学模型2.1自动导引小车的结构特点自动导引小车的研究涉及多种技术领域，是一个典型的机电一体化多技术多学科的集成系统，其机构示意图如图 2-12-1自动导引小车的机械机构部分主要包括如下几个方面：(1)(1)车体车体由车架、相应的机械电气机构、外观件等部分组成，它是自动导引小车的基础部分。车架的设计需要考虑刚性强度、整车的平稳性等重要的机械性能，重心的位置是又一关键因素，重心越低越有利于抗倾翻。在满足车载机械电气机构、外观件以及其它装置装配空间，和整车刚性要求的条件下，尽量考虑整车的外形造型美观和轻便小巧。(2)(2)驱动装置驱动装置是自动导引小车行走的执行机构，它主要由车

2、轮、减速器、制动器、电机及速度控制器等部分组成。通常情况下，驱动装置和转向装置集成在一起使用。(3)(3)蓄电池和充电装置蓄电池和充电装置是自动导引小车的动力源。自动导引小车一般采用24V24V 或 48V48V 直流工业蓄电池电能为动力， 对于传统的铅酸蓄电池， 一般需保证 8 8 小时以上的安培小时值。随着电池科技的发展，快速充电蓄电池问世，这类蓄电池的安培小时值根据实际生产需求而定，而且与之配套的采用一种先进智能快速充电技术，充五分钟电可以使用一个多小时。从而提高自动导引小车的有效使用率。充电装置有多种，目前最常用有地靴式和测挂式等。一般地，充电装置需要安全保护。(4)(4)位姿传感装置

3、位姿传感装置主要是为了从自动导引小车的当前环境中，获得小车的位姿(位置与转角)和其它相关的信息，如运行前方有无障碍等。位姿传感装置会因为采用的导引技术的不同而不同，如采用电磁感应技术的位姿传感装置主要是安装在小车上的一对探头(即感应线圈)和比较/放大电路等，而采用光学检测技术的位姿传感装置则主要是光学检测器和辅助装置等。(5)(5)导向控制装置导向控制装置是整个导引小车运动控制的核心，主要色含有硬件部分和软件部分。一般来说，尽管采用的导引技术千差万别，但是，导向控制装置的结构大体相同。硬件部分主要是数字电路部分，主要是位置环、垢差控制器等，多采用单片机实现，从而可以通过程序方便的控制自动导引小

4、车跳加速、减速和匀速运动，需要的话也可以切换偏差控制器实现直道、弯道的多棒型控制同时由于自动导引小车行走过程中对实时性要求较高，对包括速度环、电流环及驱动部分的控制器及脉冲宽度调制(PulseWidthModulation)(PulseWidthModulation)信号发生器而言， 采用模拟电路控制具有实时快速、不占用 CPUCPU 寸间的优点，特别适合电流，速度环快速 PIDPID 运算。(6)(6)专用功能执行机构自动导引小车的形式种类很多，每种实用型自动导引小车，它都不光是装备了自动导引行走功能，还装备了专用功能执行机构，以满足自动导引小车的实际功能需求，如叉车式自动导引小车的自动叉体

5、机构，转道式自动导引小车的自动辗道机构等。专用功能执行机构是根据各种自动导引小车需要完成的功能专门设计而成，具有特定专用性。(7)(7)安全保护装置在实际生产中，人与机械处于同一环境，自动导引小车作为一种运动中的动作功能机械，具安全保障功能尤为重要。安全装置的作用包括防止设备在运行中出错，也预防运行出错对人员及其运行环境设施产生的影响，直接地，安全装置的功能就是保护自动导引小车自身，以及维护自动导引小车攻用的顺利完成，同时在最大可能的范围内保护人员和运行环境设施的安全。自戴导引小车的安全装置主要是障碍检测传感装置以及避障控制装置。本论文研究对象是车体采用三轮式结构的自动导引小车，车体结构示意图

6、如图 2-22-2 所示。两个后轮作为驱动轮，利用两轮的速度差实现转向；前轮为随动轮，仅起到支撑车体的作用,而没有导向的作用。 采用这种结构的自动导引小车只有直线运动和圆弧运动两种运动形式， 较适合于固定路径导引控制和运动路径不是很复杂的导引控制中。此车体正向运行和反向运行的动力学模型是不同的， 可以只按车体正向运行情形求取其动力学模型。如果要求所求取的动力学模型对于车体正向运行与反向运行均适合，那么该车体结构必须前后对称，即前轮为操舵轮，中间两轮是驱动轮，后轮也为操舵轮的变四轮结构(如图 1-21-2) )o o 实际运行中，如果需要反向运行，只需要将自动导引小车原地旋转 180180 度以

7、后，就相当于正向运行了。2.2.自动导引小车运动学模型的建立2.2.1自动导引小车运动学分析运动学模型主要根据运动学方面的理论直接求得伺服电机端电压与车速的关系，在这种模型中，自动导引小车的速度只与电机端电压及电机电枢回路的时间常数有关，而忽略了车体质量、摩擦阻力对车速的影响。建立如图 2-32-3 所示的坐标系。图中 XOXOS S世界坐标系，v,v, ,v v,分别为左/右驱动轮轮心相对于地面的线速度(m/s),L(m/s),L 为两驱动轮之间的距离，R R 为自动导引小车绕瞬心口的转弯半径，必为自动导引图图2-2车体鳍构示意图车体鳍构示意图图 2-3 总 V 运动学粳地小车绕瞬心口转动的

8、角速度(rad/s(rad/s) )自动导引小车的运动学模型是基于以下几点假设：自动导引小车是刚性的；自动导引小车运动在水平面上；自动导引小车的左、右轮受 Y Y 力相等，且车轮与地面之间没有相对滑动；自动导引小车的车体质量、摩擦阻力、负载等的变化对车速的影响忽略不计。取为距离偏差(m(m),),为角度偏差(rad(rad),),在此设定角度以逆时针为正，顺时针为负。根据自动导引小车的车体结构和刚体平动原理可知，自动导引小车在任意时刻都是作绕车体瞬心 0 0 的转动。由图 2-32-3 可知，在 t t 时刻自动导引小车绕瞬心口的转弯半径 R R 为：自动导引小车在 t t 时刻绕瞬心口转动的

9、角速度必为由式（2-42-4）可以看出，只要正确标定小车的初始位置，控制小车左右两驱动轮的速度，可以使两轮的中心跟踪任意给定的运动轨迹，也就是说通过分别控制小车两驱动轮的速度可以使小车实现路径跟踪控制。则自动导引小车运动方程为:角度偏差量为距离偏差量为较小，由式（2-52-5）可以得到角度偏差的变化率为:式中：一跟踪路径曲率变化对角度偏差变化率的影响，当跟踪路径为直线时，其值为零。同样的，由式（2-62-6）可以得到距离偏差血血_ _vf+K=dl2式中：化率的影响，当跟踪路径为直线时，其值为零。-踪路径曲率变化对距离偏差变的变化率为:Jsin%+Ad令到状态变量由公式(2-7(2-7) ),

10、(2-8)(2-8)即可以得的自动导引小车的状态方程为(2-9)(2-9)描述自动导引小车左右轮速差的关系。它可以看成是以小车角度偏差为状态变量，以车辆左右轮速差为输入变量的状态方程，即可以通过控制自动导引小车左右轮的速度差来调节小车的角度偏差和距离偏差但由于左右轮速差不是系统的直接输入量，系统的控制输入量为工业控制机送出的 D/AD/A 值，即电压值，所以为了将控制电压作为输入加到状态方程中，需要将小车的运动学方程与反映驱动系统动态特性的传递函数合并，得到描述整个被控过程动态特性的系统状态空间数学模型。2.2.2 驱动系统数学模型的建立驱动系统的数学模型描述着计算机D/A输出值（即电压值）和

11、驱动轮转速之间的关系，设计自动导引控制器及进行仿真和试验研究都需要建立能够正确地反映车辆驱动系统特性的数学模型。自动导引小车的驱动系统如图 2-42-4 所示。由于 AGWAGW 区动系统环节较多，例如，电机调速机构包括 D/AD/A 转换、电机控制器、减速器、控制电机等；而且各部件的有关性能参数难以确定，如机械传动机构的刚度、阻尼、纵向运动惯量等机械性能参数都不便于测定，因此采用解析法建立车辆调速机构数学模型的困难很大。由于系统的输入输出信号一般总是可以测量的，而系统的动态特性必然出现于这些输入输出数据中，故可以利用输入输出数据所提供的信息来建立系统的数学模型，这种建模方法就是系统辨识。随着

12、系统辨识理论与方法的发展，应用系统辨识的方法，通过实验研究来确定系统的数学模型，是一种能满足上述要求的行之有效的途径。为了对驱动系统动态特性进行初步分析并便于以后的系统辨识，需要首先通过对其进行特定的输入信号（如阶跃输入）下的动态响应过程试验，从而可以根据试验结果判断出驱动系统模型的阶次。另外，由于输入输出信号均为离散数字信号，因此宜采用差分方程描述该系统。用差分方程定量描述一个动态系统时，必须确定出方程中的有关参数。所以，该种系统辨识的实质是一个参数估计问题，可视为一种灰箱式部分辨识问题，同时，辨识过程中由于输入输出数据受到噪声的影响，一般应看成是随机变量，因此也属于统计学范畴。在参数估计时

13、，力求使某一个被适当定义的误差标准趋于最小，以便使寻求的数学模型与试验数据有最佳拟合。在各种参数估计技术中，最小二乘法是从试验数据进行参数估计的主要手段，其获得的估计在一定条件下具有最佳的统计特性，因此该方法被广泛应用于系统辨识研究中。在系统辨识中，输入信号的类别和形式影响着所采用的辨识方法和辨识精度。用于辨识输入信号的最低要求是具有持续激励特性，即在整个观测周期上，过程的所有模态必须被输入信号持续激励。这意味着输入信号不能随意选择，否则不但辨识精度不能保证，甚至可能造成不可辨识。目前常用的信号主要是随机序列（如白噪声）和伪随机序列。理论分析表明，选用白噪声作为辨识输入信号可以保证获得较好的辨

14、识效果，但是白噪声在工程上不易实现，因此工程中一般选用最长线性移位寄存器序列（简称 M M 序列）作为辨识输入信号。M M 序列是二进制伪随机码序列（PRBSPRBS）的一种形式，它的自相关函数接近脉冲函数，具有近似白噪声的性质，可保证有较好的辨识精度。对驱动系统的模型辨识而言， M M 序列的物理意义是驱动电机电源控制器输入电压信号，它在计算机内由 D/AD/A 产生。M M 序列有 3 3 个参数，即一个电平的持续时选M M 序列就是确定这几个参数。试验开始时，应先给系统以预激励（或预扰动）。由于 M M 序列 u u（k k）实质上是周期信号，具施加于系统后，输出端响应 y y（k k）

15、最终也必定是周期波形。不过在 t=0t=0TsTs 的过渡过程初始阶段内，由于非零初始条件的作用，系统的输出在一段时间内是非平稳的，为了保证辨识精度，要避开这段非平稳过程。由于已选定,当 M M 序列的第一个周期己度过，y y（k k）dF+ +不不+ + +可可MO=4-/-/】t t+ +3与拉阶差分方程与拉阶差分方程口力下口力下(*+(*+独独) )+ +0#(+内内一一)+“一十一十0网网,(,(4)=队11(上+旌-1)之间的系之间的系数转换数转换关系为关系为+it产产(k),.2=2)4=%/,B=DB式中式中(2-13)JT，属】(2-14)H=1b1.h，&df,B=：7+ +

16、烹烹p也也已成为周期期信号后，即可认为 y(k)y(k)已具备平稳性，此时进行。(k)(k)和 y(k)y(k)的相关运算刁有意义。因此在辨识试验中将第一个周期内的 M M 序列作为预激励，而将第 1 1 个周期以后采集的试验数据留作系统辨识之用，这样做的目的是利用比较充足的数据，以提高辨识精度。系统辨识中，取电压信号u(k)u(k)序列作为输入值，小车速度信号y(k)y(k)序列作为输出值进行辨识。通过研究电压值与驱动轮转速的相互关系建立描述驱动系统动态特性的差分方程。驱动系统的数学模型选用 ARXARX 真型，模型为：/(e)=(&)=1)*(*)+(*)其中：其中：用用)=)=1+口商口

17、商/+/+利用最小二乘方法进行系统辨识，可得描述驱动系统输入输出关系的差分模型。而描述线性连续系统的数学模型是微分方程和传递函数，必须把差分方程转换成微分方程或者传递函数的形式。本文采用差分方程与微分方程系数的转换法实现f7lanf7lan 阶微分方程的周(2-10),分别是 m+1m+1 阶和 m m 阶方阵，即转换矩阵。是一个下三角矩阵，其对角线商的元素之绝对值及最后一行的元素的绝对值都是 1;1;矩阵中每个元素决定；矩阵中绝对值不等于 1 1 的其它非零元素的绝对值由下式计算：利用 MatlabMatlab 编程实现最小二乘方法系统辨识和模型转换算法，得到驱动系统频域形式的传递函数为：为

18、了将驱动系统的动态特性方程加入到系统状态方程中， 需对驱动系统进行降阶， 即把三阶传递函数降为一阶形式，从而近似简化成惯性环节和比例环节，具体计算采用 MatlaMatlab b工具软件编程实现，可得驱动系统传递函数的一阶形式为模型为：虽然对模型降阶处理使模型与实际系统有差距，但是这样可以把驱动系统的微分方程加入到状态方程中，对建模是有利的。式(2-14)(2-14)中，可以理解成左右轮的速度差，可以理解成计算机给左右驱动电机电源控制器的输入电压之差。2.2.3 自动导引小车控制系统状态空间方程由于自动导引小车采用控制两驱动轮的转速差实现路径跟踪，即当自动导引小车在跟踪路径有偏差时，采用分别将

19、两个驱动轮加、减一个纠偏的速度,而且已经把驱动系统的动态特性简化成一阶系统，因此可以把工业控制机的 D/AD/A 输出作为控制器的输入,作为模型中的状态变量分别为左、右电机的控制电压（定义右轮的电压为正），），则自动导引小车的控制结构图如图 2-52-5。以自动导引小车的左右轮转速差角度偏差和距离偏差作为系统状态变量，工业控制机的控制信号作为系统输入，可以得到被控系统状态空间方程为：rfir/d1r-a00Sb至此，己建立了系统被控过程的状态空间数学模型，也可记作(A,B,C,D)(A,B,C,D)因此自动导引小车的运行轨迹与距离偏差e e和角度偏差.,这两个参数有关，它们之间存在着非常复杂的

20、非线性关系。此外，考虑到自动导引小车的车身中线的实际偏转角度要比车轮的旋转角度要小。因此，系统在角度偏差较小，且离控制线距离较近时，旋转灵敏度要高：而在角度偏差较小，且离控制线较远时，旋转灵敏度要低。2.3自动导引小车导引方程2.3.1AGV 自动导引技术概述顾名思义， 自动导引小车包含一个自动导引系统， AGVSAGVS 是依靠它沿一定的路线自动行驶的。不同类型的 AGVSAGVS 统中采用的自动导引技术各不相同，而采用哪一种导引技术将直接影响自动导引小车系统各方面的性能。根据 AGVAGV(统中 AGV!AGV!行路线的性质，导引系统可分为固定路径导引、自由路径导引、组合路径导引三种：固定

21、路径导引是指 AGV!AGV!行路线是以某种具体的形式规定的，如图 2-6(a)2-6(a)。具体的路线可以是电磁感应导引中的导引电缆、磁导引中的磁条和光学导引中的反光带等。自由路径导引是指 AGVAGV 勺运行路线是无任何具体形式的运行轨道，AGV&AGV&虚拟的路线运行，如图 2-6(b)2-6(b)。这种虚拟的路线由控制系统间接通过一些指示装置来确定，计算机视觉等导引方式均属此类。组合路径导引是指 AGVftAGVft 多数工作区间内沿某种具体形式的固定路线运行，而在某些区域可沿控制系统指定的虚拟路线运行，如图 2-6(c)2-6(c), ,两种路径分别用实线和虚线来表示。一般综合使用上

22、述两类导引方式中的不同导引技术。一般而言，固定路径导引实施较容易，技术较为成熟，但运行路线的更改相对较为困难。自由路径导引的成本较高，同时在实际应用中还有一些具体问题需要解决，但 AGV!AGV!行路线的更改容易，柔性较高。组合路径导引可综合上两类导引系统的优点。2.3.2 AGV自动导引方程自动导引小车的运动路径一般都是直线与圆弧组成。下面就分别讨论自动导引小车在直线段与圆弧段的导引方程。2.3.2.1 直线路径导引方程AGVAGV 在直线路径上导引示意图如图 2-7(a)2-7(a)，其中，Y Y 轴与路径重合分别表示左右轮转速和车体转速,为车体转角,驱动轮半径，B B 为传感器中心距两驱动轮中心连线的距离。则车体转动角速度为：令车体初始角度为考坐标系 Y Y 轴的转动角度为L L 为驱动轮中心距