一种基于模型预测控制的磨削机器人路径跟踪控制方法技术

本发明专利技术提出了一种基于模型预测控制的磨削机器人路径跟踪控制方法，首先建立磨削机器人运动学模型，以及建立磨削机器人离散时间预测模型；然后，定义期望路径，MPC跟踪期望路径上的点。为了快速准确地跟踪期望路径，本发明专利技术设计优化目标函数，设定约束条件，采用勒让德正交多项式逼近法逐渐逼近误差，最后达到收敛的效果。本方法能够高效在线控制磨削机器人跟踪路径，且能够处理控制输入的约束，提高了磨削机器人模型的鲁棒性。削机器人模型的鲁棒性。削机器人模型的鲁棒性。

【技术实现步骤摘要】
一种基于模型预测控制的磨削机器人路径跟踪控制方法


[0001]本专利技术属于磨削机器人跟踪控制
，具体涉及一种基于模型预测控制的磨削机器人路径跟踪控制方法。

技术介绍

[0002]磨削机器人(GrindingRobot,GR)是一种多轴工业打磨机器人，具有工作空间大，灵活性高等优点，能够实现自动控制、多自由度、多用途、可编程等功能。随着智能制造业和工业4.0的不断发展，越来越多的机器人被应用到实际的生产和商业中。为了应对复杂的磨削工作环境，可以依靠操作性强的磨削机器人来代替人类的打磨工作。而对于磨削机器人，提高其路径跟踪误差的收敛性，保证其运动可控是一项基本的功能要求。磨削机器人动力学与运动学模型复杂，且模型参数模糊，复杂的模型也会导致磨削机器人的控制变得复杂。随着磨削机器人不断的工作，人们对其运动控制的精度、稳定性都提出了更高的要求，因此，解决磨削机器人路径跟踪误差大，提高磨削机器人的鲁棒性成为关键性研究。
[0003]近年来，许多学者对机器人的路径跟踪控制问题进行了研究。针对磨削机器人的非线性模型，主要的控制方法有滑模控制方法、反步控制(Back
‑
Stepping)方法、智能控制方法等。
[0004]滑模控制方法是一种特殊的变结构控制，本质上是一种非线性控制，即控制结构随着时间变化而变化。具有快速响应、设计简单、参数可变、鲁棒性稳定等优点。
[0005]反步控制(Back
‑
Stepping)方法是基于李雅普洛夫(Lyapunov)方法的非线性系统控制设计方法。其设计思路是在Lyapunov函数的基础上设计正确的系统控制率，将高阶系统分解为多个一阶系统，当阶次较低的系统稳定收敛时，整个高阶系统也就达到了稳定状态。
[0006]智能控制方法对系统的模型没有严格要求，不依赖于系统的模型来解决系统的控制问题。智能控制是指设计一个能够学习、抽象、推理、决策并对环境信息做出适应性反应的控制器或者系统，以完成由人来执行的任务。常见的智能控制方法有四种：专家控制、模糊控制、神经网络、遗传算法。
[0007]模型预测控制(ModelPredictiveControl,MPC)是一种基于模型的控制算法，其本质是在线的滚动优化。常用的模型预测控制算法有：模型算法控制(MAC)、动态矩阵控制(DMC)、广义预测控制(GPC)。模型预测控制算法在每个采样时刻，通过在线求解一个有限时域开环最优控制问题而获得控制输入序列，解得的最优控制序列只实施第一个控制作用。这是它与传统预先计算控制律的算法最大的不同。
[0008]MPC主要有三大基本特征：预测模型、滚动优化、反馈校正。采用模型预测控制的框架来解决磨削机器人的路径点跟踪控制问题，主要有三大优势。第一，模型预测控制能够显式控制输入存在的约束，缩小优化范围。第二，模型预测控制能够优化未来一段时间的系统输出，即未来一段运动轨迹，因此适用于路径点跟踪的滚动优化过程。第三，模型预测控制能够根据系统对象的实际输出修正系统的实际输入，使系统的实际输出接近于期望输出。
[0009]模型预测控制对模型的精度要求不高，具有建模方便、滚动优化、鲁棒性好、稳定性好等优点，但迭代步骤多，计算复杂，耗时较长。因此，需要研究MPC算法的可行性，提高MPC算法的运行效率。

技术实现思路

[0010]本专利技术的目的是针对现有磨削机器人模型存在参数模糊的情况，导致磨削机器人路径跟踪误差大的问题，而提供一种基于模型预测控制的磨削机器人路径跟踪控制方法。
[0011]为实现本专利技术的目的所采用的技术方案是：
[0012]一种基于模型预测控制的磨削机器人路径跟踪控制方法，该方法包括以下步骤：
[0013]步骤一、建立磨削机器人运动学模型；
[0014]步骤二、建立磨削机器人离散时间预测模型；
[0015]步骤三、定义期望路径：P＝{X
r
(k)∈R
n
|X
r
(k)＝p(θ
r
(k))}，
[0016]其中，P为定义的参数期望路径，X
r
(k)为k时刻机器人参考位置，p(θ
r
(k))为k时刻的路径，θ
r
(k)为k时刻的路径参数，θ
r
在k+1时刻的预测期望路径为：
[0017][0018]其中，w
p
(k)为k时刻期望路径角速度，为k时刻机器人控制输入偏差线性表达式；
[0019]步骤四、设计优化目标函数：
[0020][0021]其中，J为代价函数(Cost Function)，Q与R为权重矩阵，ρ为权重系数，ε为松弛因子，N为状态误差的预测时域，N
c
为控制输入偏差量的预测时域，θ
ref
为期望轨迹；系统预测误差为：
[0022]e(k+1)＝X(k+1)
‑
X
r
(k+1|k)，
[0023]其中，X(k+1)为下一时刻机器人的实际位置，X
r
(k+1|k)为下一时刻机器人的预测位置；
[0024]步骤五、设定约束条件；
[0025]设置控制量约束条件为：
[0026]u
min
(k+t)≤u(k+t)≤u
max
(k+t)，k＝0，1
…
N
c
‑
1，
[0027]设置控制增量约束条件为：
[0028]Δu
min
(k+t)≤Δu(k+t)≤Δu
max
(k+t)，k＝0，1
…
N
c
‑
1，
[0029]最终，约束条件转化为：
[0030][0031]步骤六、采用正交多项式逼近法求解最优控制，具体过程如下：
[0032]定文则称f(x)与g(x)在区间[a，b]上正交，记作：
[0033][0034]定义则称f(x)与g(x)在区间[a，b]上带权p(x)正交，定义一个k次多项式序列使序列满足：
[0035][0036]采用勒让德正交多项式，定义在区间[
‑
1，1]上带权P(x)＝1正交的多项式P
n
(x)：
[0037][0038]定义推导公式为：
[0039][0040]由机器人的运动学模型知：
[0041][0042][0043]对公式分离变量，化简得到勒让德方程：
[0044][0045]由勒让德方程的解得出每个时刻参数的最优解。
[0046]在上述技术方案中，步骤1中，定义X＝[x，y，θ]T
为机器人的实际位姿，(x，y)为机器人实际位置，θ为机器人实际角度；定义X
r
＝[x
r
，y
r
，θ
r
]T
...

【技术保护点】

【技术特征摘要】
1.一种基于模型预测控制的磨削机器人路径跟踪控制方法，其特征在于，包括以下步骤：步骤一、建立磨削机器人运动学模型；步骤二、建立磨削机器人离散时间预测模型；步骤三、定义期望路径：P＝{X
r
(k)∈R
n
|x
r
(k)＝p(θ
r
(k))}，其中，P为定义的参数期望路径，X
r
(k)为k时刻机器人参考位置，p(θ
r
(k))为k时刻的路径，θ
r
(k)为k时刻的路径参数，θ
r
在k+1时刻的预测期望路径为：其中，w
p
(k)为k时刻期望路径角速度，为k时刻机器人控制输入偏差线性表达式；步骤四、设计优化目标函数：其中，J为代价函数(Cost Function)，Q与R为权重矩阵，ρ为权重系数，ε为松弛因子，N为状态误差的预测时域，N
c
为控制输入偏差量的预测时域，θ
ref
为期望轨迹；系统预测误差为：e(k+1)＝X(k+1)
‑
X
r
(k+1|k)，其中，X(k+1)为下一时刻机器人的实际位置，X
r
(k+1|k)为下一时刻机器人的预测位置；步骤五、设定约束条件；设置控制量约束条件为：u
min
(k+t)≤u(k+t)≤u
max
(k+t)，k＝0，1
…
N
c
‑
1，设置控制增量约束条件为：Δu
min
(k+t)≤Δu(k+t)≤Δu
max
(k+t)，k＝0，1
…
N
c
‑
1，最终，约束条件转化为：步骤六、采用正交多项式逼近法求解最优控制，具体过程如下：定义∫
ab
f(x)g(x)＝0，则称f(x)与g(x)在区间[a，b]上正交，记作：(f，g)＝∫
ab
f(x)g(x)＝0；定义∫
ab
p(x)f(x)g(x)＝0，则称f(x)与g(x)在区间[...

【专利技术属性】
技术研发人员：彭志，翟冉，
申请(专利权)人：天津理工大学，
类型：发明
国别省市：