三轮移动机器人的精确运动控制设计
2021-06-21文相容周宇生
文相容,周宇生
(贵州大学 数学与统计学院,贵阳 550025)
轮式移动机器人是一种通过驱动轮子转动来实现运动功能的非完整约束结构,具有结构简单、能耗低和运动灵活等优点[1]。轮式移动机器人按轮子数量可分为独轮、两轮、三轮、四轮和多轮移动机器人。在实际应用中,会根据需要采用不同的轮式移动机器人。独轮和两轮机器人占地面积小且运动最为灵活,但竖直方向部分容易翻倒,是需要自平衡控制的倒立摆结构[2]。三轮移动机器人虽然灵活性不如独轮和两轮,但结构稳定不容易翻倒,且灵活性比四轮移动机器人要强很多。因此兼具稳定性和灵活性优点的三轮移动机器人在实际生活工作中应用非常广泛。
目前关于三轮移动机器人的控制研究大都侧重于其运动学方程[3-6],通过将其运动学方程转化为链式标准型,设计速度控制器跟踪给定的目标速度[7-9]。但在实际中一般是通过驱动力或力矩来实现控制目的,所以设计力或力矩控制器更符合实际。文[10]针对高速运动情况下,对轮式移动机器人进行了运动学、动力学模型重建,并利用反演控制方法设计了抗侧滑运动学反演控制器,同时利用逆动力学控制方法设计了抗扰动逆动力学控制器,完成了机器人对预定轨迹的跟踪。一般情况下,实际运动任务是控制三轮移动机器人精确沿给定目标轨迹曲线运动,而动力学方程只是单纯描述其运动速度和驱动力或力矩之间的关系。因此,需要将给定的目标轨迹曲线转化为速度目标形式,这样就可以将原来的运动控制问题转化为基于动力学方程的一般跟踪控制问题,从而使得问题变得简单且容易实现。文[11]利用平面曲线基本理论,将两轮式倒立摆的目标轨迹曲线转化为速度目标形式,结合其动力学方程为两轮式倒立摆设计了力矩控制器,精确实现往返运动控制。
随着科学技术的发展,轮式移动机器人的精确轨迹跟踪变得越来越重要,目前关于精确轨迹跟踪控制的研究主要侧重于先进控制器的设计,文[12]通过间接自适应模糊滑模控制方法,构造基于旋转子系统和纵向子系统的复合控制,实现速度跟踪和倾角稳定。文[13]设计了基于反步法的自适应控制,实现了轮式倒立摆的输出跟踪稳定。文[14]为解决平台与安装机器人之间的扰动、非线性和非完整约束之间的动力学耦合问题,提出了一种基于反步法的自适应滑模控制器用于移动机械臂的轨迹跟踪。从这些文献的仿真结果来看,无论控制设计方法多么先进,实际轨迹总是与目标轨迹曲线有一定的偏差,特别是在刚开始的一段时间内。主要原因是实际运动速度与目标速度之间的初始速度误差比较大,导致整个运动过程中的累积位置误差越来越大。因此,必须根据运动任务设计合适的速度跟踪目标,尽量减少初始速度误差。通过分析其侧向运动速度为零这一非完整约束,利用微分几何理论得到目标轨迹曲线与速度目标之间的一一对应关系。引入一个微分同胚的变量变换,将前向速度目标转化为和实际初始速度更接近的形式,通过减少初始速度误差来尽量减少三轮移动机器人运动时的累积位置误差。最后通过仿真说明所提轨迹跟踪目标设计和鲁棒控制设计方法的有效性。
1 三轮移动机器人的运动学方程
如图1所示,三轮移动机器人的后2轮上各装有一个驱动马达,同时前轮通过控制方向盘来实现转向。当后2轮中心点C(x,y)随着三轮移动机器人在平面上做连续光滑运动时,点C的运动轨迹是一条光滑曲线,此时点C在与切向垂直方向的侧向速度为0,如若不然,其轨迹曲线会出现不光滑的尖点。因此三轮式移动机器人在平面上做光滑曲线运动时一般受到如下非完整约束
图1 三轮移动机器人结构简图
(1)
(2)
根据方程(2)中的第二式可以知道,轨迹曲线的切向量长度就是点C沿该曲线运动的前向速度。因此,可以将方程(2)改写为
(3)
此外,当三轮移动机器人的后2轮不侧滑不空转时,需要满足下面2个完整约束
(4)
其中:θ是三轮移动机器人的偏航角;θl和θr分别是左右两轮的转角;r是轮子的半径。
(5)
然后将方程(2)的第二式代入方程(5)并结合方程(1),整理得到三轮移动机器人后两轮所受的运动约束方程
(6)
接下来,分析三轮移动机器人前轮所受到的约束。
如图2所示,P(xp,yp)点具有双重身份。一方面当P点作为前轮中心,在不发生侧滑运动时,其侧向速度为0,即满足方程
图2 P点速度示意图
(7)
另一方面当P点作为中间体的前端点时,该点的速度满足如下关系
(8)
由方程(7)和(8)得到
(9)
方程(9)是一个重要的非完整约束,它描述了前轮转向和后轮运动速度之间的关系。将方程(3)的第一式代入方程(9),则方程(9)可改写为
(10)
这里φ是前轮操舵转向角,将其看作一个控制变量,因为它是通过人为控制方向盘转向得到的。
结合方程(3)、(5)和(9),将三轮移动机器人的所有运动约束总结为
(11)
2 三轮移动机器人的动力学方程
令三轮移动机器人的广义坐标为q=(x,y,θ,θr,θl)T,方程(11)可以表示为以下矩阵形式
(12)
其中
利用非完整力学系统的Euler-Lagrange方程,三轮移动机器人的动力学方程为
(13)
方程(13)中的F(q)选取为
F(q)S=0。
(14)
接下来需要计算三轮移动机器人的动能。根据图1所示,得到如下位置关系
其中,(xwl,ywl),(xwr,ywr)分别是左右轮的中心坐标。此时三轮移动机器人上的各中心点速度分别表示为
因此,三轮移动机器人的后2轮的前向动能和转动动能之和表示为
同样地,可以将三轮移动机器人的前轮和中间体的前向动能和转动动能之和分别表示为
其中:MB是中间体质量;Mw是轮子质量;Iwd是轮子绕z轴方向转动惯量;Iw是轮子绕轮轴方向转动惯量;IB是中间体绕z轴方向转动惯量。
将Lagrange函数L=Tw+TB+Tf代入方程(13),然后按状态变量的各阶导数整理得到
(15)
其中:
将方程(12)两边同时关于t求导,然后代入方程(15)得
(16)
在方程(16)的左右两边同时左乘ST(q),结合方程(14)消去等式中的Lagrange乘子得
整理上式,最终可以将三轮移动机器人动力学方程表示为如下状态方程形式
(17)
其中
β1=a2r2MB+4a2r2Mw+2d2r2Mw+4r2IB+4a2Iw+8r2Iwd,
β2=(2d2r2Mw+4r2IB+8Iwdr2-3a2r2MB-8a2r2Mw-8a2Iw)cosφ-β1。
3 三轮移动机器人的轨迹跟踪运动控制
3.1 速度跟踪目标设计
(18)
对方程(18)两边同时关于t求导得
(19)
将方程(18)和(19)交叉相乘并相减得
因此中心点C运动速度与运动轨迹曲线之间的关系式为
(20)
由于φ和u1之间有约束关系,本文将φ和u2看作控制变量。观察发现方程(17)是解耦的,可以先通过第二个方程将u1设计出来。然后结合方程(9)有
(21)
再利用方程(21)将控制器φ设计出来。然后将控制变量φ代入方程(17)的第一式,设计控制器u2实现最终的轨迹跟踪任务。
从上式可以看出,当参数变换后,前向速度目标也是随之而改变的。因此,上式中含有曲线相对曲率的第二式才是对轨迹曲线的本质刻画。
其中,α>0,β>0,r>0,并且满足
(22)
由方程(22)有r=l,α=lβ2。因此函数φ(η)可以设计为
φ(η)=-(βη+1)le-βη+l,
其中l是目标轨迹曲线长度。
(23)
其中:s=φ(t)=-(βt+1)le-βt+l.
3.2 偏航转速控制系统
由于方程(17)是解耦的,先考虑其偏航转速控制系统
(24)
偏航转速控制系统(24)比较简单,容易设计反馈跟踪控制器。为了加强它的鲁棒性,采用积分滑模思想处理不确定性因素的影响[15]。
其中d1(t)是偏航转速误差系统受到的不确定性因素。
其中k是误差反馈控制增益参数。
再将轨迹跟踪目标设计成积分滑模面S1(ω(t))=0,且
其中G1>0是合适的常数。这样,切换控制部分设计为
其中:μ是滑模控制参数;ε是外部扰动最大振幅。因此,u1设计为
u1(t)=u10(t)+u11(t)。
(25)
最后,结合方程(21)和(25),最终设计的操舵角控制器为
(26)
3.3 前向速度控制系统
接下来考虑前向速度控制系统
(27)
对系统(27)利用反馈线性化思想处理,设
(28)
得到一个简单的控制系统
令X=[x1,x2]T=[s,υ]T,前向速度控制系统改写为
(29)
再将控制方程(29)转化成误差系统,令
则前向速度误差系统为
其中d2(t)是前向速度误差系统受到的不确定性因素。
为了使得前向速度误差尽量小,可以将前向速度误差的权重取得足够大[11]。利用线性二次型最优控制理论,h(t)设计为
h(t)=-R-1BT[P(t)Y(t)+b(t)],
其中:P(t)∈2×2,b(t)∈2满足方程
-PA-ATP+PBR-1BTP-Q=0,
为了增强反馈控制的鲁棒性,同样采用积分滑模思想来处理不确定性因素。系统(29)的控制器基础部分设计为
h20(t)=-R-1BT[P(t)Y(t)+b(t)]。
引入积分滑模函数
其中,G2是适当的常矩阵。
积分滑模面设计为S2(X(t))=0,因此系统(29)的控制最终设计为
h2(t)=h20(t)+h21(t),
(30)
其中:h21是切换的不连续控制,用来补偿系统不确定性因素和外部扰动的影响,
h21(t)=-(μ+ε||Y||1)(G2B)-1sgn(S2(X(t)))。
结合方程(28)和(30),前向速度控制器设计为
(31)
4 仿真实现
考虑目标轨迹曲线是单位圆,假设初始时刻三轮移动机器人是静止的,且目标轨迹曲线为
由曲线基本理论,目标轨迹曲线的曲率为k(t)=1。
根据方程(20),轨迹曲线的速度目标形式表示为
(32)
再根据方程(23),改进的速度跟踪目标设计为
(33)
假设三轮移动机器人的各部分参数选择如下
M=3 kg,Mw=2 kg,a=1 m,r=0.1 m,Iw=0.01 kgm2,Iwd=0.005 kgm2,I=0.01 kgm2。
l=π/2,β=0.5,k=2,μ=0.01,ε=2,G1=1.8,G2=diag(100,1)。
若前向速度误差控制系统和偏航转速误差控制系统分别受到如下未知扰动影响
且将φ(t)设计为
此时,关于控制器(26)和(31)中的所有量就都已知了,实验如图3、4所示。
图3 前向速度误差图
从图3和图4可以看出,采用速度目标(32)会使得初始速度误差不为零,而改进后的速度跟踪目标(33) 从初始时刻开始速度误差为零。如若初始速度误差过大,自然会导致三轮移动机器人在整个运动过程中累积位置误差也很大,最终导致实际运动轨迹曲线严重偏离目标轨迹曲线。如图5所示,由于笔者设计控制器时采用了积分滑模的思想,所设计的滑模控制器具有很强的鲁棒性。因此即使误差控制系统存在不确定性因素的影响,采用速度目标(33)和积分滑模控制器时,得到的实际运动轨迹几乎和目标轨迹重合,反之采用速度目标(32)时,即使同样采用积分滑模控制,得到的实际轨迹曲线也会严重偏离目标轨迹曲线,这主要是由于初始速度误差导致的累积位置误差太大所致。
图4 偏航转速误差图
图5 三轮移动机器人在平面上的实际运动轨迹
5 结 论
通过分析三轮移动机器人的运动约束方程和运动规律,针对给定的目标轨迹曲线,给出了一种新的速度跟踪目标和控制器设计方法。该方法可以通过选择合适的光滑函数,为三轮移动机器人设计合适的前向速度和偏航转速目标,使得在控制过程中能够极大地减少误差控制系统的初始速度误差,从而达到减少累积位置误差的目的。仿真结果表明,采用文中所提出的速度跟踪目标和控制方法,可以使得三轮移动机器人能精确地沿着给定的目标轨迹曲线运动。
提出的精确轨迹运动控制方法完全可以推广到三维空间中的轨迹曲线跟踪运动,并应用于航天航空、机器人、机械制造等需要精确轨迹运动控制的领域。