一种基于固定时间稳定理论的移动机器人NMPC方法技术

本发明专利技术公开了一种基于固定时间稳定理论的移动机器人NMPC方法，包括如下步骤：建立两轮差分驱动的移动机器人的运动学模型；将非线性模型预测控制问题描述为最优控制问题，引入哈密顿量并对连续系统进行离散化处理，得到最优性的离散必要条件，并获得优化问题；采用固定时间收敛率对优化问题的解进行迭代，并将所得解作为连续广义最小残差法的初始解，对轮式移动机器人进行控制，实现轮式移动机器人的点镇定，提供更好的闭环性能和干扰抑制性能，提高系统的实时性，使系统状态能够在固定时间内收敛，克服了非线性模型预测控制实时性较差的问题。问题。问题。

【技术实现步骤摘要】
一种基于固定时间稳定理论的移动机器人NMPC方法


[0001]本专利技术涉及移动机器人
，具体为一种基于固定时间稳定理论的移动机器人NMPC方法。

技术介绍

[0002]近年来，由于劳动力的短缺与劳动成本上涨等问题，越来越多的工厂与企业选择运用机器人来代替部分人工，帮助更快生产；随着电子通信、控制理论、电力电子、人工智能等技术的不断提高与发展，机器人系统的研究与应用已经成为行业研究热点，并受到广泛关注。其中，轮式移动机器人在物流运输、便民服务等方面都已经有了较为成熟的运用，快递公司里的货物运输传送机器人、银行里的引导型机器人，甚至在海底捞里的菜品运送机器人等等都是轮式移动机器人。由于其机械结构与控制模型比较简单直观，所以轮式移动机器人能够广泛运用于日常生活中。
[0003]在轮式移动机器人的问题当中，通常有点镇定问题、路径跟踪问题以及轨迹跟踪问题，这些是移动机器人的经典问题；其中，点镇定问题由于其存在Brockett定理，即不存在连续光滑的纯状态反馈控制率，这在轮式移动机器人中是一个经典难题，并引起了许多学者的广泛关注；许多学者为克服这一难点提出了各种方法，但是，在设计控制域时并没有考虑到机器人本身受到的约束，如：状态约束、速度约束等；因此急需一种基于固定时间稳定理论的移动机器人NMPC(非线性模型预测控制)方法来解决上述问题。

技术实现思路

[0004]本专利技术提供一种基于固定时间稳定理论的移动机器人NMPC方法，提高系统的实时性，使系统状态能够在固定时间内收敛，克服了非线性模型预测控制实时性较差的问题。
[0005]为实现上述目的，本专利技术提供如下技术方案：一种基于固定时间稳定理论的移动机器人NMPC方法，包括如下步骤：
[0006]S1、建立两轮差分驱动的移动机器人的运动学模型；
[0007]S2、引入哈密顿量并对连续系统进行离散化处理，得到最优性的离散必要条件F(U,x,t)；
[0008]S3、基于固定时间稳定理论设计控制器对轮式移动机器人进行控制，实现轮式移动机器人的点镇定，其中，采用固定时间收敛率对F(U,x,t)进行求解。
[0009]优选的，在步骤S1中，运动学模型为：其中，x∈R和y∈R为移动机器人的位置，θ为机器人运动方向与X正方向的夹角，v和ω为移动机器人的线速度与角速度，状态量的矩阵形式为[x y θ]T
，控制量的矩阵形式为[v ω]T
。
[0010]优选的，移动机器人的运动学模型设定约束信息：
[0011]优选的，在步骤S2中，建立非线性模型，其状态方程及等式约束为：
[0012][0013]C(x(t),u(t))＝0；
[0014]其中，x(t)∈R
n
为状态向量，u(t)∈R
m
为控制输入向量；
[0015]将非线性模型预测控制问题可以被描述为最优控制问题，最优控制问题的目标函数为：
[0016][0017][0018]其中，为终端约束，L(
·
)为损失函数，x
*
(κ,t)为从κ＝0时刻开始的x(t)的轨迹，最优控制输入为每个t时域的最优控制问题的解；
[0019][0020][0021]其中，P和Q为权重矩阵，x
f
为期望状态。
[0022]优选的，引用哈密顿量表示被积函数：
[0023]H(x,u,σ,λ)＝L(x,u)+σ
T
f(x,u)+λ
T
C(x,u)；
[0024]其中，σ∈R
n
和λ∈R
m
为共态变量和拉格朗日乘数。
[0025]优选的，在步骤S2中，进行离散化处理：将预测时域划分为N步，其最优化的离散后的必要条件为：
[0026][0027][0028]定义为输入向量序列与Lagrange乘数序列构成的向量：
[0029][0030]则最优性的必要条件为：
[0031][0032]优选的，在步骤S3中，固定时间收敛率为：
[0033][0034]其中，对且a＞0，定义「F」
a
＝|F|
a
sign(F)；α1＞0，α2＞0，＞0，若β∈(0,1)，则0＜β1＜1＜β2；
[0035]若F
U
为非奇异，则有：
[0036]初始化U(0)求解方程为：通过U(0)迭代求解出U。
[0037]优选的，采用前向差分近似法与连续/广义最小残差法对U进行计算，具体为：
[0038]a、运用雅可比矩阵与向量乘积进行前向差分近似，给出雅可比矩阵与O∈R
mN
、O∈R
nN
、O∈R的乘积：
[0039]b、
[0040]其中，h为前向差分步长，则：
[0041][0042]c、运用连续/广义最小残差法算法对U进行计算。
[0043]与现有技术相比，本专利技术的有益效果：本专利技术运用非线性模型预测控制方法对轮式移动机器人进行点镇定控制，并采用固定时间稳定理论，提供更好的闭环性能和干扰抑制性能，进一步提高系统的实时性，使系统状态能够在固定时间内收敛，克服了非线性模型预测控制实时性较差的问题，本专利技术方法能够更好的实现轮式移动机器人的点镇定，同时也能更好的运用在实际的工业当中。
附图说明
[0044]附图用来提供对本专利技术的进一步理解，并且构成说明书的一部分，与本专利技术的实施例一起用于解释本专利技术，并不构成对本专利技术的限制。
[0045]在附图中：
[0046]图1是本专利技术轮式移动机器人参考系描述示意图；
[0047]图2是本专利技术轮式移动机器人的运动曲线示意图；
[0048]图3是本专利技术轮式移动机器人的线速度变化曲线图；
[0049]图4是本专利技术轮式移动机器人的角速度变化曲线图。
具体实施方式
[0050]以下结合附图对本专利技术的优选实施例进行说明，应当理解，此处所描述的优选实施例仅用于说明和解释本专利技术，并不用于限定本专利技术。
[0051]实施例：如图1所示，一种基于固定时间稳定理论的移动机器人NMPC(非线性模型预测控制)方法，包括如下步骤：
[0052]S1、建立两轮差分驱动的移动机器人的运动学模型；
[0053]运动学模型为：其中，x∈R和y∈R为移动机器人的位置，θ为机器人运动方向与X正方向的夹角，v和ω为移动机器人的线速度与角速度，状态量的矩阵形式为[x y θ]T
，控制量的矩阵形式为[v ω]T
。
[0054]将轮式移动机器人的运动学模型进行离散化：
[0055][0056]其中，ΔT为采样时间。
[0057]移动机器人的运动学模型设定约束信息：
[0058]S2、引入哈密顿量并对连续系统进行离散化处理，得到最优性的离散必要条件F(U,x,t)；
[0059]建立非线本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于固定时间稳定理论的移动机器人NMPC方法，其特征在于：包括如下步骤：S1、建立两轮差分驱动的移动机器人的运动学模型；S2、引入哈密顿量并对连续系统进行离散化处理，得到最优性的离散必要条件F(U,x,t)；S3、基于固定时间稳定理论设计控制器对轮式移动机器人进行控制，实现轮式移动机器人的点镇定，其中，采用固定时间收敛率对F(U,x,t)进行求解。2.根据权利要求1所述的一种基于固定时间稳定理论的移动机器人NMPC方法，其特征在于：在步骤S1中，运动学模型为：其中，x∈R和y∈R为移动机器人的位置，θ为机器人运动方向与X正方向的夹角，v和ω为移动机器人的线速度与角速度，状态量的矩阵形式为[x y θ]
T
，控制量的矩阵形式为[v ω]
T
。3.根据权利要求2所述的一种基于固定时间稳定理论的移动机器人NMPC方法，其特征在于：移动机器人的运动学模型设定约束信息：4.根据权利要求1所述的一种基于固定时间稳定理论的移动机器人NMPC方法，其特征在于：在步骤S2中，建立非线性模型，其状态方程及等式约束为：C(x(t),u(t))＝0；其中，x(t)∈R
n
为状态向量，u(t)∈R
m
为控制输入向量；将非线性模型预测控制问题可以被描述为最优控制问题，最优控制问题的目标函数为：min:n:其中，为终端约束，L(
·
)为损失函数，x
*
(κ,t)为从κ＝0时刻开始的x(t)的轨迹，最优控制输入为每个t时域的最优控制问题的解；优控制输入为每个t时域...

【专利技术属性】
技术研发人员：陆群，刘甜田，赵伟，夏菽兰，殷宇翔，蒋成晨，翁嘉鑫，
申请(专利权)人：盐城工学院，
类型：发明
国别省市：