[发明专利]一种基于模型预测控制的磨削机器人路径跟踪控制方法

说明书

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

技术领域

本发明属于磨削机器人跟踪控制技术领域，具体涉及一种基于模型预测控制的磨削机器人路径跟踪控制方法。

背景技术

磨削机器人(GrindingRobot,GR)是一种多轴工业打磨机器人，具有工作空间大，灵活性高等优点，能够实现自动控制、多自由度、多用途、可编程等功能。随着智能制造业和工业4.0的不断发展，越来越多的机器人被应用到实际的生产和商业中。为了应对复杂的磨削工作环境，可以依靠操作性强的磨削机器人来代替人类的打磨工作。而对于磨削机器人，提高其路径跟踪误差的收敛性，保证其运动可控是一项基本的功能要求。磨削机器人动力学与运动学模型复杂，且模型参数模糊，复杂的模型也会导致磨削机器人的控制变得复杂。随着磨削机器人不断的工作，人们对其运动控制的精度、稳定性都提出了更高的要求，因此，解决磨削机器人路径跟踪误差大，提高磨削机器人的鲁棒性成为关键性研究。

近年来，许多学者对机器人的路径跟踪控制问题进行了研究。针对磨削机器人的非线性模型，主要的控制方法有滑模控制方法、反步控制(Back-Stepping)方法、智能控制方法等。

滑模控制方法是一种特殊的变结构控制，本质上是一种非线性控制，即控制结构随着时间变化而变化。具有快速响应、设计简单、参数可变、鲁棒性稳定等优点。

反步控制(Back-Stepping)方法是基于李雅普洛夫(Lyapunov)方法的非线性系统控制设计方法。其设计思路是在Lyapunov函数的基础上设计正确的系统控制率，将高阶系统分解为多个一阶系统，当阶次较低的系统稳定收敛时，整个高阶系统也就达到了稳定状态。

智能控制方法对系统的模型没有严格要求，不依赖于系统的模型来解决系统的控制问题。智能控制是指设计一个能够学习、抽象、推理、决策并对环境信息做出适应性反应的控制器或者系统，以完成由人来执行的任务。常见的智能控制方法有四种：专家控制、模糊控制、神经网络、遗传算法。

模型预测控制(ModelPredictiveControl,MPC)是一种基于模型的控制算法，其本质是在线的滚动优化。常用的模型预测控制算法有：模型算法控制(MAC)、动态矩阵控制(DMC)、广义预测控制(GPC)。模型预测控制算法在每个采样时刻，通过在线求解一个有限时域开环最优控制问题而获得控制输入序列，解得的最优控制序列只实施第一个控制作用。这是它与传统预先计算控制律的算法最大的不同。

MPC主要有三大基本特征：预测模型、滚动优化、反馈校正。采用模型预测控制的框架来解决磨削机器人的路径点跟踪控制问题，主要有三大优势。第一，模型预测控制能够显式控制输入存在的约束，缩小优化范围。第二，模型预测控制能够优化未来一段时间的系统输出，即未来一段运动轨迹，因此适用于路径点跟踪的滚动优化过程。第三，模型预测控制能够根据系统对象的实际输出修正系统的实际输入，使系统的实际输出接近于期望输出。

模型预测控制对模型的精度要求不高，具有建模方便、滚动优化、鲁棒性好、稳定性好等优点，但迭代步骤多，计算复杂，耗时较长。因此，需要研究MPC算法的可行性，提高MPC算法的运行效率。

发明内容

本发明的目的是针对现有磨削机器人模型存在参数模糊的情况，导致磨削机器人路径跟踪误差大的问题，而提供一种基于模型预测控制的磨削机器人路径跟踪控制方法。

为实现本发明的目的所采用的技术方案是：

一种基于模型预测控制的磨削机器人路径跟踪控制方法，该方法包括以下步骤：