带拖车的轮式移动机器人系统的建模与仿真

第12卷第1期2000年1月系统仿真学报JOURNAL OF SYSTEM SIMULATIONV ol.12No.1January,2000文章编号:1004-731X (2000)01-0043-4带拖车的轮式移动机器人系统的建模与仿真杨 凯1,黄亚楼1,徐国华2(11南开大学计算机与系统科学系,天津300071;21中科院自动化所,北京100080)收稿日期:1998-09-28摘 要:带拖车的轮式移动机器人系统是一种典型的非完整、欠驱动系统。

本文建立了带多个拖车的移动机器人系统的运动学模型,对系统的运动特性进行了分析,并在此基础上对系统的运动进行了数值仿真和图形仿真,验证了理论分析的正确性。

关键词:移动机器人系统;运动学模型;龙格-库塔法;计算机仿真中图分类号: T P24213 文献标识码:AModeling and Simulation of Tractor -trailorRobot Systems .KinematicsYANG K ai 1,H UAN G Ya -lou 1,X U Guo -hua 2((1.Department of Computer and System Science,Nankai Universi ty,T ianjin 300071;2.Institute of Automation,Chinese Academy of Sciences,Beiji ng 100080,China)Abstract:A mobile robot wit h mult-i trailers is a t ypical nonholonomic,underactuated system.T his paper establishes a kine -matic model for such system.Based on the kinematic model,the motion of the system is analytically studied,and the simula -tion of the motion for thi s system is conducted with t he means of Runge -Kut ta met hod and computer gr aphics.It proves that t he theoretical analysis is right.Keywords:mobile robot;underactuated system;Rung e -K utta;computer simulation1 引言移动机器人是机器人学中的一个重要分支,本文所讨论的是一种特殊类型的移动机器人系统)))带拖车的轮式移动机器人(T ractor-trailer robot ),它由一系列相互铰链在一起的多个二轮式刚体小车组成,运行在一个平面上。

带拖车的轮式移动机器人系统的一种情形是由一个卡车型的牵引车拖动着一个或多个被动的拖车组成,牵引车可以执行类似于汽车那样的运动:驱动轮向前或向后运动,转向轮向左或向右转向,拖车跟踪牵引车的运动路径。

作为典型的欠驱动、非完整系统,带拖车的移动机器人系统的运动学、规划、控制等方面的研究明显不同于其它机器人系统,由于系统运动规律、控制特性上的理论结果亟待验证,因此,带拖车的移动机器人系统的仿真是极有价值的。

本文针对一般结构形式的带拖车的移动机器人系统建立系统的运动学模型,研究模型的递推形式以解决拖车节数变化带来的模型重构问题,同时就一些问题开展理论分析与仿真验证。

2 系统的运动学模型211 基本假设与变量说明为了使所建立的数学模型对各种车体链接形式均成立,这里以非标准型带拖车的轮式移动机器人系统为研究对象,所谓非标准型就是相邻两车体的链接点不在前一车体的轮轴上而是在链接轴的某点上(如图1所示),且假设:整个系统是在平面上运动;车轮是无滑动的;车体关于其纵向轴线对称;车轮与地面是点接触,且是纯滚动运动;车体是刚体;用于车体连接的关节之间是无摩擦的。

为了叙述简便起见,将整个系统看成是由N 个车体所组成,分别为其建立附体坐标系{x i ,y i }。

{x i ,y i ,H i }(i =1,2,,,N )是每个车体的位形描述,x i 和y i 是两轮之间的中心点在系统坐标系下的坐标,H i 是x i 轴与X 轴之间的夹角(如图1和2所示)。

为便于描述,定义如下变量:#B n ,A n 分别为第n 节车体与第n -1节和第n +1节车体的链接点#V A n ,V Bn 分别为A n 和B n 点的速度#l n 表示B n 点到第n 节车体轴心的距离#c n 表示A n 点到第n 节车体轴心的距离图1 带两节拖车的移动机器人系统图2 第n 节车体的位形及参数#<n 表示第n 节车体与第(n +1)节车体的夹角#X n 表示第n 节车体的旋转角速度#v n 表示轴心点的线速度#驱动轮的初始线速度为u,A 为驱动轮运动方向与牵引车纵轴之间的夹角,并规定逆时针为正,顺时针为负。

(参见图1和图2)212 方程描述:由图2可以得到如下关系式[2]:V A n =1 00-c nv n X n,V B n =1 00 l nv n X n(1)由于A n 和B n +1是同一个点,V Bn +1和V An 描述的是同一个点的速度,只是处于不同的坐标系,因此有[2]:V Bn+1=cos (U n )- sin (U n )sin (U n ) cos (U n )A An(2)其中,U n =H n-H n +1比较(1)(2)两式可推出:v n +1X n +1=1 00 l n +1-1cos (U n ) -sin (U n )sin (U n) cos (U n )1 00 -c n v n X n) (<n ) 记R n =cos (<n ) c n sin (<n )1l n +1sin (<n ) -c n l n +1cos (<n ),T n =R n R n -1,R 1则v n +1X n +1=T n v 1X 1(3)对于v 1,X 1可直接得到v 1X 1=u cos A (u sin A )/b 1(4)别一方面,在全局坐标系中可求出:Ûx nÛy n ÛH n =v n cos H n v n sin H n X n(5)以上几式即为系统的运动学的递推公式。

图33 系统的运动学特性一般的路径都是一系列直线和圆弧组成的,而直线是圆弧的特例(因为其半径可视为无穷大),下面以圆为例来研究带拖车的移动机器人系统牵引车与拖车之轨迹关系,以及车体参数与运动轨迹的关系。

引理[3]:当牵引车的运动从直线过渡到圆时,拖车的运动也将过渡到圆,两车之间的夹角<指数级收敛到稳定状态值(其中,<为相邻两车的夹角)。

依据这一结论,当带拖车的移动机器人的运动从直线到圆转换时,牵引车、拖车的运动最终将形成半径不同的同心圆,每个车体对应的圆的半径的大小与车体参数有关,也与牵引车所跟踪的圆的半径有关,具体关系如下:定理[3]:如果拖车与牵引车的连接点并非在牵引车轮轴的中心点上,而是处于两个轮轴之间,假设连接点距前面车体轮轴中心为C ,距后面车体轮轴中心为L (如图3所示)设前面车体沿着一个半径为r 的圆运动时,则后面车体的运动路线将收敛到半径为:R =r 2+C 2-L 2的圆上。

由定理可以看出:¹当C >L 时,后面车体的运动半径大于前面车体的运动半径,即在做圆运动时,后面车体处于外圆。

º当C <L 且C 2\L 2-r 2时,后面车体的运动半径将大于前面车体的运动半径,即在做圆运动时,后面车体处#44#系 统 仿 真 学 报2000年1月于内圆。

»当C =L 时,后面车体的运动半径等于前面车体的运动半径,即在做圆运动时,后面车体与前面车体的运动轨迹是重合的。

4 运动仿真仿真的基本任务是:让牵引车按指定的路线运动,来观测牵引车、拖车的运行状态和轨迹,其目的有两方面:验证运动学规划与控制的一些理论结果;对理论结果有一个形象化的直观描述,并对其进行解释。

411 仿真研究的基本任务与思路仿真的思路就是对已建立的运动学方程求解,并利用求解出的结果在计算机上模拟显示系统的运动过程。

由于所建立起来的运动学方程是非线性方程,且是非完整系统,很难用解析方法求出封闭解,而需采用数值计算方法来求解。

由于龙格-库塔法[3]精度较高,且计算量相对较少,故采用之。

412 仿真结果与分析为验证系统的运动特性及上述的理论结果,对以Hero-1型移动机器人为牵引车,并带有两个拖车的系统进行仿真。

仿真程序的输入参数为各车体之间的距离(l 1,c 1,l 2,c 2,l 3)以及牵引车的驱动角A 和线速度u ,并可改变运动路径的参数,由此来观测车体距离对运动轨迹的影响。

仿真过程取车体参数不同,路径参数不同以及不同路径的衔接等情形来观测结果。

仿真中,设车体的初始形态为:H 1=H 2=H 3=P /2;图4,图5,图6描述的是牵引车沿指定的圆运动的情形,从仿真结果可以看出,当牵引车沿指定的圆运动时,拖车会很快收敛于一圆形路径上,尽管引理指出的是渐进特性,但由于系统以指数级收敛,所以这一结论是极有价值的。

同时,也可定性地看出三个车体运动半径的大小关系,从而验证了定理的正确性。

图4 l 1=10,c 1=5,l 2=24,c 2=5,l 3=24图5 l 1=10,c 1=24,l 2=5,c 2=24,l 3=24图6 l 1=10,c 1=10,l 2=10,c 2=10,l 3=10,A =P /6图7 l 1=10,c 1=10,l 2=10,c 2=10,l 3=10A =-P /18y A =P /6对于不同路段的衔接,图7和图8分别模拟了不同半径的圆的衔接、圆与直线的衔接,这两个图同样验证引理的正确性。

6 结束语本文建立了带多节拖车的移动机器人系统的运动学递推公式,并以Hero -1移动机器人带有两个拖车的系统为#45#第12卷1期杨凯等:带拖车的轮式移动机器人系统的建模与仿真图8 l 1=10,c 1=10,l 2=10,c 2=10,l 3=10A =0y A =-P /18y A =0的直线)圆弧)直线的衔接例,进行了仿真研究,验证了所建立起来的运动学模型的正确性以及部分理论结果。

参考文献:[1] Ulf Lars son,Caj Zell,etc.Navigating an Articulated Vehicle andReversing with a Trailer [A].Proceedings of IEEE.International Conference on Robotics and Automation [C].IEEE Press,1994.2398-2404.[2] Jean -Paul Laumond .Controllability of a M ultibody M obileRobot [J ].IEEE T ransactions on Robotics and Automation,1993,9(6):755-763.[3] 徐国华.带拖车的轮式移动机器人系统的研究[D].天津:南开大学,1998.作者简介:杨 凯,女,23岁,助教,研究领域:移动机器人运动规划;黄亚楼,男,34岁,博士、教授,研究领域:多机器人协调,机器人控制;徐国华,男,30岁,博士,研究领域:多机器人协调,移动机器人控制。