全向轮运动平台分析.docxVIP

全轮转向式小车一、坐标系与位置表示图1地理坐标系与体坐标系定义如图所示的坐标系，地理坐标系{，},体坐标系{，}，坐标之间夹角为θ，P点位置描述为由地理坐标转为体坐标的映射由正交旋转矩阵完成反方向变换矩阵如下二、运动学模型与控制律2.1全向轮直角坐标运动学方程图2轨迹跟踪示意图坐标系参照图2，对于地理坐标中的位置指令和速度指令将对应的误差在体坐标系中表示出来对上式求导的到[1]:将上式合并写出得到位置误差微分方程2.1.1全向轮直角坐标下控制律设计设李雅普诺夫函数为求其导数如下，当渐进稳定时导数小于0；,,上式系数为正时，李雅普诺夫函数的导数小于零，系统渐进稳定代入微分方程得到控制律如下：2.2差动轮直角坐标运动学方程差动轮与全向轮的区别是，全向轮小车速度方向与四个轮子的共同朝向相同可为任意方向，而差动轮小车的切向速度方向与X轴重合，故方程中=0,微分方程如下：2.2.1差动轮直角坐标下控制律设计选择Lyapunov函数如下：对上式沿求导：选择如下速度控制输入：)将上式代入Lyapunov函数导数得到：当上式系数为正时，，故以上Lyapunov函数选择正确。由此得到基于运动学模型的轨迹跟踪速度控制律为[2]：其中，为控制器参数。2.2.2控制器参数选取将控制律代入微分方程得下式：上式在零点附近线性化，忽略高次项得系数值与角速度和速度指令值共同决定系统根，当系数为正是所有根为负数。2.3对比仿真与结果仿真系统结果图如下：图3轨迹跟踪结构图图中q=(v ω)T，v、ω分别为移动机器人的线速度和角速度，=(x y θ)T,对于差动机器人运动学方程可表示为：=J图中J=；；；对于全向轮机器人运动学方程可表示为：对角速度为0.2和线速度为5的圆形轨迹进行跟踪，仿真结果如下图：图4圆形轨迹跟踪仿真图图中×点线为差动轮跟踪轨迹，О点线为全向轮跟踪轨迹。三、全向轮平台的设计对全向轮采用如下图所示的结构时，进行系统分析与设计图5互补型全向轮(omni wheels)3.1运动学模型图6全向轮式移动机器人运动学模型移动坐标固定在机器人重心上，而质心正好位于几何中心上。机器人 P 点在全局坐标系的位置坐标为：(x ,y,θ)，三个全向轮以3号轮中心转动轴反方向所为机器人的X轴。假设三个全向轮完全相同，三个全向轮中心到车体中心位置的距离L。在移动坐标的速度用表示。由文献[3]可得三个全向轮的速度与其在移动坐标和全局坐标系下的速度分量之间的关系分别为以下二式：3.2动力学模型在移动坐标中，设机器人在沿轴和方向上收到的力分别为FXe和FYe第1、2、3号驱动轮提供给机器人的驱动力分别为f1、f2、f3，机器人惯性转矩为M，根据牛顿第二定律可得到如下的动力学方程：在地理坐标系X—Y下的方程如下：3.3基于动力学模型的控制器设计如上式所示，基于机器人动力学模型的控制方案，直接根据机器人的动力学模型设计运动控制器，控制器的输出为机器人上驱动电机的驱动电压。基于动力学模型的控制方案，不需对驱动电机进行底层的速度控制，消除了底层速度控制带来的延时。由动力学方程：可知在体坐标系中各个方向上的控制输入输出是独立的并且相互之间无耦合；于是可在体坐标中对各个控制量分别进行控制。当以各个电机电压作为控制量U时，对控制量U进行矩阵变换后可得到各个方向控制量Fu=。先对系统参数进行辨识，得到由控制量Fu到速度V的传递函数；然后设计Fu的控制器，进过变换Fu后得到各个电机的控制量UFu 。速度控制指令由第2节控制律求得。3.4基于编码器的位姿推算圆弧模型在文献[4]中介绍机器人里程计圆弧模型是把移动机器人在运动过程中的实际轨迹通过圆弧去逼近。图7平台样品示意图[5]图8采样期间的圆弧运动轨迹图中和分别为在采样时间间隔内起始点与终点的位姿坐标，AB为采样期间的圆弧轨迹，利用图中几何关系可以得到运动轨迹为圆弧时的推算公式如下：当较小时可采用直线模型随着移动距离的增加，误差逐渐加大，其误差的来源主要包括系统误差和非系统误差。系统误差跟实际采用的器件的精度和测量上的误差等方面产生的；非系统误差是在移动过程中随机发生的误差，主要包括：测位轮子的打滑、路况等。由于非系统误差不容易消除，因此，这里将通过实验的方法来校准机构的安装精度，减小因系统误差对定位精度产生较大影响。影响测量误差的主要参数是编码器输出一个脉冲对应轮子运动的距离和两个定位轮之间的距离L，和L精度校正的具体方法和实现步骤如下：编码器一个脉冲代表定位轮运行的距离校正方法：使两个定位轮在室内平面上沿着一条 5 米长度的直线运行，编写软件程序，对与定位轮同轴相连的两个自由编码器的输出脉冲进行计数，将该数值记录左右自由编码器输出脉冲个数NL和NR，根据公式求出每次测量计算得到的值，再取平均值即可。经过多次测试实验结果列表。定位轮之间的