双轮差速驱动式移动机器人运动规划.pdf

《双轮差速驱动式移动机器人运动规划.pdf》由会员上传分享，免费在线阅读，更多相关内容在应用文档-天天文库。

1、双轮差速驱动式移动机器人运动规划王仲民，阎兵（高速切削与精密加工天津市重点实验室天津工程师范学院，天津300222）摘要：研究两轮独立驱动移动机器人的运动规划问题，以两驱动轮中任一驱动轮轮心为基点进行移动机器人的运动规划，并与传统的以两驱动轮间轮距中点为基点的运动规划方法进行了对比。仿真结果表明，以轮心为研究基点的方法较传统方法控制简单，节省了大量计算时间，为有效解决移动机器人运动控制的实时性问题奠定了基础。关键词：轮式移动机器人；运动规划；轨迹跟踪1轮式移动机器人(WheeledMobileRobot,驱动轮的半径；ω、ω分别为WMR左、右驱动LRWMR)具有

2、非常广泛的应用前景与商业价值，广义轮的角速度。的说，任何带有轮式移动机构如汽车等都属于轮式移动机器人的范畴。由于存在非完整约束，使得对YWMR进行控制日益受到国内外学者的普遍关注ωL[1][2]。运动规划是WMR控制的主要问题之一，也是WMR完成工作任务的首要前提。通常两轮独立驱动的WMR在进行运动规划时，是以两驱动轮的轮YR距中点为基点来进行的，WMR通过路径规划器将XR已经规划好的路径转换成随时间变化的两独立驱Lθ动轮的角速度，从而控制两个驱动轮行进，但由于rRWMR具有高度的非线性时滞性，这就势必增加了ωR[3][4]实时控制的复杂性。而以两驱动轮中任一驱

3、动轮的轮心为基点进行WMR运动规划，另一驱动轮OX只作随动运动，其角速度是依据两驱动轮间轮基的图1WMR结构简图固连关系、两轮的角速度约束关系而获得，其结果大大减少了计算量，进而提高了WMR的计算效率。1.1两驱动轮间的约束方程1WMR运动学建模显然，无论WMR运动到何处，其左、右驱动轮间轮距L是不会改变的，因此左右轮的坐标与轮WMR由车体、两个驱动轮和一个随动轮组成，间距L的关系为随动轮仅在运动过程中起支撑作用，其在运动学模()2()22型中的影响忽略不记。为简单起见，假设WMR在xL−xR+yL−yR=L（1）水平地面上运动，车轮只旋转不打滑，将WMR简令α

4、为WMR的初始姿态，定义其逆时针为正，化成如图1所示。以WMR的右驱动轮为研究对象，00且α∈[-180,180]，则由图1可得WMR的姿态角与O-XY为WMR工作场地的固定参考坐标系，R-XRYR两驱动轮轮距中点的关系为为与WMR固连的坐标系，R为固连坐标系的原点，与右轮轮心重合；YR与两驱动轮轴线重合，指向左()xR−xLtanα+θ=（2）轮；X和XR间的夹角为θ，即WMR的位姿可表示为yL−yRTT（x，y，θ）；左、右轮的坐标分别为()x,y、LL根据式（1）和式（2），得T(xRR,y)。设L为WMR两驱动轮的轮距；r为WMRxR−xL=Lsin(α

5、+θ)（3）作者简介：王仲民（1974-），男，副教授，工学博士；阎兵（1968-），男，教授，工学博士。yL−yR=Lcos(α+θ)（4）1假设WMR在任意一初始位置AB，经时间t同时，WMR左、右驱动轮间的运动关系由式T转过θ角后到达另一位置A′B′，如图2所示，则左（6）决定，因此只要控制U=[ωω,]，就可以RL驱动轮比右驱动轮多转过的曲线位移为T得到WMR的位姿。又设[x,y]为WMR轮距中点的CA′=Lθ=ωLrt−ωRrt（5）坐标，v,ω分别为WMR的平移速度和旋转角速度，即：则传统的以WMR两驱动轮轮距中点建立的运动学[5]模型为ωL−ωR=

6、Lθ/()rt（6）⎡⎤⎡x&cosθ0⎤⎢⎥⎢⎥⎡⎤vy&=sinθ0⋅⎢⎥（10）⎢⎥⎢⎥ωY⎢⎥⎢⎣⎦⎣θ&01⎥⎦⎣⎦ACLYRv=(ωωrr+)/2，ωωω=−()rr/L（11）RLRLBXRA′θ由式（10）和（11）得θB′θ⎪⎧xrr&=+⎡⎣()ωωRLcosθ⎤⎦/2⎨（12）⎪⎩yrr&=+⎡⎣()ωωθRLsin⎤⎦/2OX2两种运动规划方法分析图2WMR运动位姿变化对于传统的以轮距中点为基点的轨迹跟踪问题，WMR根据该点的速度分配给左右两个驱动轮，由于WMR的运动方式只有直线运动和圆弧运从而控制两个驱动轮行进，对式（10）积分而得到动

7、两种，若作为基点的驱动轮（文中为右驱动轮）实际位姿，通过与期望位姿进行比较而得到位姿偏的角速度ω==ωc已知，则左驱动轮的角速度R差。同时，WMR在实际的行走过程中，必然存在ωL根据式（6）得累积误差，如果累积误差过大，就会严重影响WMR的准确定位以及任务的完成，这就必然要求对其进ωL=ω+Lθ/()rt（7）行位置矫正。在进行位置矫正时，首先要根据驱动若θ=0，即对于直线运动而言，显然轮经过的路程，通过积分得到轮轴中心点的位姿并ω==ωω，两驱动轮同速，即直线运动是曲线与规划器中所设定的位姿对比，得出需校正的位姿LR运动的特例。偏差，然后通过矩阵求逆运算而得到

8、两驱动轮的角速度，在同时