一种考虑输入约束的移动机器人固定时间跟踪控制方法

1.本发明涉及移动机器人控制技术领域，尤其涉及一种考虑输入约束的移动机器人固定时间跟踪控制方法。


背景技术：

2.移动机器人集信息采集、动态规划、行为决策与控制等多种功能于一体，由于具有机械结构简单、运动灵活及较强的外部环境自适应能力等特点，使得移动机器人在军事、工业、农业以及民用等领域获得了广泛的应用。
3.高性能的跟踪控制是移动机器人完成这些应用的前提，其中跟踪误差的收敛速度是实现移动机器人高性能跟踪控制的一项关键技术指标。
4.固定时间控制可以使得移动机器人系统跟踪误差做到固定时间收敛，且其收敛时间与系统状态的初始值无关。然而，为了达到系统状态的固定时间收敛，在固定时间控制的初始阶段固定时间控制器输出的控制信号往往存在幅值过大的问题，这极易使系统发生输入受限问题，导致系统控制性能变差，严重时甚至会引起系统失稳。


技术实现要素：

5.本发明目的就是为了弥补已有技术的缺陷，提供一种考虑输入约束的移动机器人固定时间跟踪控制方法，本发明采用固定时间控制理论设计使得系统跟踪误差固定时间收敛的运动学控制器及动力学控制器，同时解决了固定时间控制中初始控制信号过大的问题。
6.本发明是通过以下技术方案实现的：
7.一种考虑输入约束的移动机器人固定时间跟踪控制方法，具体步骤如下：
8.步骤1、建立包含执行机构动态的移动机器人跟踪控制系统模型；
9.步骤2、基于系统运动学模型设计移动机器人固定时间跟踪运动学控制器；
10.步骤3、基于包含执行机构动态的移动机器人系统动力学模型设计固定时间跟踪动力学控制器。
11.步骤1所述的建立包含执行机构动态的移动机器人跟踪控制系统模型，具体过程如下：
12.1.1所述移动机器人在满足非完整约束的情况下，其运动学模型可描述为
[0013][0014]
式中，q＝[x,y,θ]
t
∈r3为移动机器人的位姿矢量，其中，x，y分别表示移动机器人在x轴向及y轴向的坐标，θ为移动机器人的方向角；q&为移动机器人位姿矢量的一阶导数；μ＝[v,ω]
t
为由移动机器人的线速度和角速度构成的矢量，其中，v为线速度，ω为角速度。
[0015]
1.2依据lagrange建模方法，移动机器人的动力学模型可描述为
[0016][0017]
式中，为移动机器人的正定惯性矩阵，其中，m和i分别表示移动机器人的质量和惯量；为移动机器人位姿矢量的二阶导数；为移动机器人的离心力和哥氏力矩阵；g(q)∈r3为移动机器人系统的重力项，对于在平面运动的移动机器人该项为零；为未知地面摩擦项；τd∈r3为系统外部有界扰动项；为控制力矩变换阵，其中，r1和2b分别表示移动机器人驱动轮的半径和两驱动轮的间距；τ＝[τr,τ
l
]
t
∈r2为移动机器人两驱动轮控制力矩所组成的矢量，τr，τ
l
分别表示由移动机器人右轮和左轮直流驱动电机所产生的驱动力矩；a
t
(q)＝[-sinθ,cosθ,0]
t
∈r3为与系统非完整约束相关的矩阵；为系统lagrange乘子。
[0018]
1.3将(1)式及其及一阶导数代入(2)式中并左乘s
t
(q)，同时结合s
tat
(q)＝0，可得：
[0019][0020]
式中，中，为μ的一阶导数；为μ的一阶导数；
[0021]
1.4假设移动机器人的左右驱动轮由直流电机驱动，在忽略直流电机电感的情况下，电机的动态方程可表示为
[0022][0023]
式中，下标j＝l,r表示左、右轮电机；τ
mj
为电机产生的力矩；k
tj
为电机的力矩常数；ij为相电流；uj为相电压；rj为电机绕组电阻；k
bj
为反电动势系数；为电机转子机械角速度。
[0024]
1.5驱动轮角速度和电机转子机械角速度间的关系可表示为
[0025][0026]
式中，为驱动轮的角速度；n为传动比。
[0027]
1.6驱动轮控制力矩可表示为
[0028]
τj＝nτ
mj
ꢀꢀꢀ
(6)
[0029]
式中，τj为驱动轮控制力矩。
[0030][0031]
1.7由式(3)—式(7)可得包含电机动态的移动机器人动力学模型：
[0032][0033]
式中，u＝[ur,u
l
]
t
为由驱动轮电机相电压构成的矢量，ur为右轮电机的相电压，u
l
为左轮电机的相电压；
[0034]
1.8在移动机器人的实际控制中，由于相关物理参数难以精确获得。因此，考虑移动机器人相关物理参数的不确定因素，式(8)可进一步描述为
[0035][0036]
式中，a
10
＝a
1-δa1；a
20
＝a
2-δa2；b
10
＝b
1-δb1；b
20
＝b
2-δb2；a
10
、a
20
、b
10
和b
20
分别为a1、a2、b1和b2的名义值，δa1、δa2、δb1和δb2为相应参数的不确定部分；
[0037][0038]
假设||f||≤d1，d1为未知正常数。
[0039]
1.9当考虑直流电机的输入约束时，式(9)可重写为
[0040][0041]
式中，sat(u)＝[sat(ur),sat(u
l
)]
t
，其中，sat(
·
)为饱和函数。
[0042]
1.10为方便处电机的输入约束，定义如下函数：
[0043][0044]
式中，u
mj
为直流电机控制输入的上界；sign(
·
)为符号函数；uj(j＝r,l)为电机的控制输入。
[0045]
1.11由式(11)可得sat(uj)＝θ(uj)uj。由0《θ(uj)≤1可知，存在一个常数ρ满足：0《ρ≤min(θ(uj))≤1。
[0046]
1.12定义移动机器人的输出信号为
[0047][0048]
式中，d为正常数；xm为移动机器人输出的x轴向坐标；ym为移动机器人输出的y轴向坐标。
[0049]
1.13移动机器人跟踪的参考信号给定为
[0050][0051]
式中，x
mr
为参考信号的x轴向坐标；y
mr
为参考信号的y轴向坐标；xr虚拟移动机器人的x轴向坐标；yr为虚拟移动机器人的y轴向坐标；θr为虚拟移动机器人的方向角。且xr，yr及θr满足关系：
[0052][0053]
式中，vr和ωr分别为虚拟移动机器人的线速度和角速度，vr》0。
[0054]
步骤2所述的基于系统运动学模型的移动机器人固定时间跟踪控制器设计，具体过程如下：
[0055]
2.1系统运动学控制器设计。首先，定义跟踪误差：
[0056][0057]
式中，e
p
为跟踪误差；e
p1
为x轴向的跟踪误差；e
p2
为y轴向的跟踪误差。对式(15)求导可得：
[0058][0059]
式中，为e
p
的一阶导数；为y
mr
的一阶导数；为ym的一阶导数。
[0060]
2.2为保证e
p
的固定时间收敛，设计系统运动学控制器为
[0061][0062]
式中，运动学控制器设计参数：k1》0，k2》0，k3》0，0《a1《1，a2》1；
[0063]
2.3设计李亚普诺夫函数对该函数进行求导可得：
[0064][0065]
由式(18)可得e
p
固定时间收敛且的收敛时间t1满足关系：
[0066][0067]
步骤3所述的基于包含执行机构动态的移动机器人系统动力学模型固定时间跟踪控制器设计，具体过程如下：
[0068]
3.1定义速度跟踪误差：
[0069][0070]
式中，e
v1
为线速度跟踪误差；e
v2
为角速度跟踪误差。
[0071]
3.2对式(19)求导可得：
[0072][0073]
式中，为ev的一阶导数；为μ的一阶导数；为μc的一阶导数。
[0074]
3.3将式(10)代入式(20)可得：
[0075]
[0076]
式中，
[0077]
3.4ψ的范数满足关系d2＝max{1,d1}为未知常数，
[0078]
3.5由式(21)，系统的动力学控制器可设计为
[0079][0080]
式中，k4》0，k5》0，k6》0，0《a3《1，a4》1为动力学控制器设计参数；》1为动力学控制器设计参数；分别为ρ，d2的估计值，其自适应律设计为
[0081][0082]
3.6设计李亚普诺夫函数
[0083][0084]
式中，
[0085]
3.7对上式求导可得：
[0086][0087]
将式(22)代入式(25)可得：
[0088][0089]
3.8当选择合适的参数k6使k6min{a
10
,a
20
}》1时，式(26)可写为
[0090][0091]
由式(24)及式(27)可知，||ev||，是有界的，再由ρ及d2的有界性可得及也是有界的，从而可保证的有界性，即ζ为某一正常数。
[0092]
3.9为证明ev固定时间收敛，设计李亚普诺夫函数
[0093][0094]
3.10对式(28)求导并代入式(22)可得：
[0095][0096]
式中，
[0097]
3.11由式(29)可得ev固定时间收敛且收敛时间t2满足关系：
[0098][0099]
3.12由步骤2及步骤3可知，移动机器人可在固定时间t＝max{t1，t2}内实现对参考信号的跟踪。
[0100]
本发明的优点是：本发明不仅具有好的跟踪控制性能，而且可以确保输入约束满足系统执行机构的要求，解决固定时间控制初始控制信号过大的问题。
附图说明
[0101]
图1为本发明控制方法工作流程示意图；
[0102]
图2为没有输入约束情况下xm跟踪效果示意图；
[0103]
图3为没有输入约束情况下ym跟踪效果示意图；
[0104]
图4为有输入约束情况下xm跟踪效果示意图；
[0105]
图5为有输入约束情况下ym跟踪效果示意图；
[0106]
图6为没有输入约束情况下控制信号示意图；
[0107]
图7为有输入约束情况下控制信号示意图。
具体实施方式
[0108]
下面结合附图对本发明做进一步说明。
[0109]
如图1-图7，一种考虑输入约束的移动机器人固定时间跟踪控制方法，包括以下具体技术步骤：
[0110]
步骤1，建立包含执行机构动态的移动机器人跟踪控制系统模型，具体过程如下：
[0111]
1.1所述移动机器人在满足非完整约束的情况下，其运动学模型可描述为
[0112][0113]
式中，q＝[x,y,θ]
t
∈r3为移动机器人的位姿矢量，其中，x，y分别表示移动机器人在x轴向及y轴向的坐标，θ为移动机器人的方向角；为移动机器人位姿矢量的一阶导数；μ＝[v,ω]
t
为由移动机器人的线速度和角速度构成的矢量，其中，v为线速度，ω为角速度。
[0114]
1.2依据lagrange建模方法，移动机器人的动力学模型可描述为
[0115][0116]
式中，为移动机器人的正定惯性矩阵，其中，m和i分别表示移动机器人的质量和惯量；为移动机器人位姿矢量的二阶导数；为移动机器人的离心力和哥氏力矩阵；g(q)∈r3为移动机器人系统的重力项，对于在平面运动的移动机器人该项为零；为未知地面摩擦项；τd∈r3为系统外部有界扰动项；为控制力矩变换阵，其中，r1和2b分别表示移动机器人驱动轮的半径和两驱动轮的间距；τ＝[τr,τ
l
]
t
∈r2为移动机器人两驱动轮控制力矩所组成的矢量，τr，τ
l
分别表示由移动机器人右轮和左轮直流驱动电机所产生的驱动力矩；a
t
(q)＝[-sinθ,cosθ,0]
t
∈r3为与系统非完整约束相关的矩阵；为系统lagrange乘子。
[0117]
1.3将(1)式及其及一阶导数代入(2)式中并左乘s
t
(q)，同时结合s
tat
(q)＝0，可得：
[0118]
[0119]
式中，式中，为μ的一阶导数；为μ的一阶导数；
[0120]
1.4假设移动机器人的左右驱动轮由直流电机驱动，在忽略直流电机电感的情况下，电机的动态方程可表示为
[0121][0122]
式中，下标j＝l,r表示左、右轮电机；τ
mj
为电机产生的力矩；k
tj
为电机的力矩常数；ij为相电流；uj为相电压；rj为电机绕组电阻；k
bj
为反电动势系数；θ&
mj
为电机转子机械角速度。
[0123]
1.5驱动轮角速度和电机转子机械角速度间的关系可表示为
[0124][0125]
式中，为驱动轮的角速度；n为传动比。
[0126]
1.6驱动轮控制力矩可表示为
[0127]
τj＝nτ
mj
ꢀꢀꢀ
(6)
[0128]
式中，τj为驱动轮控制力矩。
[0129][0130]
1.7由式(3)—式(7)可得包含电机动态的移动机器人动力学模型：
[0131][0132]
式中，u＝[ur,u
l
]
t
为由驱动轮电机相电压构成的矢量，ur为右轮电机的相电压，u
l
为左轮电机的相电压；
[0133]
1.8在移动机器人的实际控制中，由于相关物理参数难以精确获得。因此，考虑移动机器人相关物理参数的不确定因素，式(8)可进一步描述为
[0134]
[0135]
式中，a
10
＝a
1-δa1；a
20
＝a
2-δa2；b
10
＝b
1-δb1；b
20
＝b
2-δb2；a
10
、a
20
、b
10
和b
20
分别为a1、a2、b1和b2的名义值，δa1、δa2、δb1和δb2为相应参数的不确定部分；
[0136][0137]
假设||f||≤d1，d1为未知正常数。
[0138]
1.9当考虑直流电机的输入约束时，式(9)可重写为
[0139][0140]
式中，sat(u)＝[sat(ur),sat(u
l
)]
t
，其中，sat(
·
)为饱和函数。
[0141]
1.10为方便处电机的输入约束，定义如下函数：
[0142][0143]
式中，u
mj
为直流电机控制输入的上界；sign(
·
)为符号函数；uj(j＝r,l)为电机的控制输入。
[0144]
1.11由式(11)可得sat(uj)＝θ(uj)uj。由0《θ(uj)≤1可知，存在一个常数ρ满足：0《ρ≤min(θ(uj))≤1。
[0145]
1.12定义移动机器人的输出信号为
[0146][0147]
式中，d为正常数；xm为移动机器人输出的x轴向坐标；ym为移动机器人输出的y轴向坐标。
[0148]
1.13移动机器人跟踪的参考信号给定为
[0149][0150]
式中，x
mr
为参考信号的x轴向坐标；y
mr
为参考信号的y轴向坐标；xr虚拟移动机器人的x轴向坐标；yr为虚拟移动机器人的y轴向坐标；θr为虚拟移动机器人的方向角。且xr，yr及θr满足关系：
[0151]
[0152]
式中，vr和ωr分别为虚拟移动机器人的线速度和角速度，vr》0。
[0153]
步骤2，基于系统运动学模型的移动机器人固定时间跟踪控制器设计，具体过程如下：
[0154]
2.1系统运动学控制器设计。首先，定义跟踪误差：
[0155][0156]
式中，e
p
为跟踪误差；e
p1
为x轴向的跟踪误差；e
p2
为y轴向的跟踪误差。对式(15)求导可得：
[0157][0158]
式中，为e
p
的一阶导数；为y
mr
的一阶导数；为ym的一阶导数。
[0159]
2.2为保证e
p
的固定时间收敛，设计系统运动学控制器为
[0160][0161]
式中，运动学控制器设计参数：k1》0，k2》0，k3》0，0《a1《1，a2》1；
[0162]
2.3设计李亚普诺夫函数对该函数进行求导可得：
[0163][0164]
由式(18)可得e
p
固定时间收敛且的收敛时间t1满足关系：
[0165]
步骤3，基于包含执行机构动态的移动机器人系统动力学模型固定时间跟踪控制器设计，具体过程如下：
[0166]
3.1定义速度跟踪误差：
[0167][0168]
式中，e
v1
为线速度跟踪误差；e
v2
为角速度跟踪误差。
[0169]
3.2对式(19)求导可得：
[0170][0171]
式中，为ev的一阶导数；为μ的一阶导数；为μc的一阶导数。
[0172]
3.3将式(10)代入式(20)可得：
[0173][0174]
式中，
[0175]
3.4ψ的范数满足关系d2＝max{1,d1}为未知常数，
[0176]
3.5由式(21)，系统的动力学控制器可设计为
[0177][0178]
式中，k4》0，k5》0，k6》0，0《a3《1，a4》1为动力学控制器设计参数；
[0179][0180]
分别为ρ，d2的估计值，其自适应律设计为
[0181][0182]
3.6设计李亚普诺夫函数
[0183]
[0184]
式中，
[0185]
3.7对上式求导可得：
[0186][0187]
将式(22)代入式(25)可得：
[0188][0189]
3.8当选择合适的参数k6使k6min{a
10
,a
20
}》1时，式(26)可写为
[0190][0191]
由式(24)及式(27)可知，||ev||，是有界的，再由ρ及d2的有界性可得及也是有界的，从而可保证的有界性，即ζ为某一正常数。
[0192]
3.9为证明ev固定时间收敛，设计李亚普诺夫函数
[0193][0194]
3.10对式(28)求导并代入式(22)可得：
[0195][0196]
式中，
[0197]
3.11由式(29)可得ev固定时间收敛且收敛时间t2满足关系：
[0198][0199]
3.12由步骤2及步骤3可知，移动机器人可在固定时间t＝max{t1，t2}内实现对参考信号的跟踪。
[0200]
为验证所设计方法的有效性，本发明给出了考虑输入约束的移动机器人固定时间
跟踪控制方法及没有考虑输入约束的移动机器人固定时间跟踪控制方法的对比效果图。为便于对比分析，系统中所有参数设置相同：
[0201]
参考的线速度和角速度vr和ωr分别设置为vr＝0.1m/s，ωr＝0.1rad/s；d＝0.1；u
mr
＝u
ml
＝20v；移动机器人系统物理参数设置为r＝0.1m，b＝0.3m，i＝4.3kg
·
m2，m＝8kg，n＝6，k
tr
＝k
tl
＝0.21n
·
m/a；rr＝r
l
＝6.4ω；k
br
＝k
bl
＝0.05v/rad
·
s-1
；系统运动学控制器参数设置为k1＝0.2，k2＝0.1，k3＝1，a1＝0.8，a2＝1.1；系统动力学控制器参数设置为k4＝6，k5＝6，k6＝6，a3＝0.3，a4＝1.3；系统参数的不确定部分设置为＝1.3；系统参数的不确定部分设置为δa1＝0.05a
10
、δa2＝0.05a
20
、δb1＝0.05b
10
和δb2＝0.05b
20
。
[0202]
从图2
‑‑
图7可以看出，在考虑输入约束的情况下本发明所述方法跟踪控制效果与不考虑输入约束的跟踪控制效果基本一致，能够很好地实现对给定信号的给定时间跟踪控制。但不考虑输入约束的控制信号在控制的初始阶段出现了过大的控制输入信号，这极易使系统发生输入受限问题，导致控制性能下降，严重的情况下会使系统失稳。
[0203]
因此，本发明所述控制方法不仅具有好的控制性能，而且可以确保输入约束满足系统执行机构的要求，解决固定时间控制初始控制信号过大的问题。