多关节刚性机械臂有限时间自适应容错控制方法及系统

本发明属于刚性机械臂位置跟踪控制，具体涉及一种多关节刚性机械臂有限时间自适应容错控制方法及系统。

背景技术：

1、机械臂自身是一个具有高度非线性、存在参数不确定性及外部干扰的复杂非线性系统，但是由于机械臂在改善生产环境、提高生产效率以及降低制造成本等方面具有的显著优势，使机械臂在生产生活中被广泛应用，上到太空勘探、下到深海探测、大到军事制造、小到精密零件加工等都离不开机械臂的应用，这都与机械臂自身的优点密不可分。

2、随着人们对产品质量要求的提高，对机械臂系统的控制要求也愈来愈高。特别是在实际工业生产中，对机械臂的控制要求更高，例如，常常需要机械臂在有限的空间范围内完成规定的动作或者为了提高产量要求机械臂在有限的时间内完成固定的任务量。与此同时，机械臂系统常常会受到一些外在干扰或自身元件发生故障，在这种情况下要保证机械臂系统仍然能够正常工作就存在一定的困难。因此，对于机械臂系统进行有效控制十分必要。

3、传统的pid控制由于不需要被控对象的模型信息，被广泛应用于工业领域。然而，执行器长期处于反复运动等状况下难免会发生故障，影响机械臂进行抓取和放置等操作。使用机械臂传感器得到实现对周围环境的感知和测量，当其出现电路短路等故障时，会影响机械臂的控制精度。一旦出现故障，传统pid控制下机械臂将无法正常工作。

4、容错控制是指当控制系统中的执行器元件、传感器元件或者其他元部件发生故障时，采取有效的措施对故障做出补偿，实现系统的稳定并且性能指标能够保持在合理范围内。因此，为了提高机械臂系统的稳定性和可靠性，改善系统的整体控制性能，需要有效的容错控制方法去解决传感器和执行器故障来保持系统鲁棒性，并提高机械臂系统的轨迹跟踪性能。

技术实现思路

1、针对目前机械臂系统由于受到执行器元件和传感器元件发生故障，参数摄动、外界干扰因素的影响从而减弱机械臂系统控制效果的技术问题，本发明的目的在于提出一种多关节刚性机械臂有限时间自适应容错控制方法，有效减少传感器和执行器故障对控制精度的影响，有较好的位置跟踪效果，能够保证系统输出位置在有限时间内约束到指定范围内。

2、本发明为了实现上述目的，采用如下技术方案：

3、多关节刚性机械臂有限时间自适应容错控制方法，包括如下步骤：

4、步骤1.建立考虑未知扰动的多关节刚性机械臂动力学系统数学模型，同时建立机械臂传感器故障和机械臂执行器故障的数学模型；

5、步骤2.设计考虑传感器和执行器故障的机械臂有限时间自适应容错控制器，将系统输出在有限时间内约束到期望位置的小邻域范围内，同时保证所有闭环信号有界；

6、步骤3.选取系统的lyapunov函数进行推导，证明对由步骤2设计的考虑传感器和执行器故障的机械臂有限时间自适应容错控制器所控制的机械臂系统lyapunov稳定；

7、步骤4.利用步骤2设计的考虑传感器和执行器故障的机械臂有限时间自适应容错控制器，实现对多关节刚性机械臂有限时间自适应容错控制。

8、此外，在多关节刚性机械臂有限时间自适应容错控制方法的基础上，本发明还提出了一种与之相适应的多关节刚性机械臂有限时间自适应容错控制系统，其采用如下技术方案：

9、模型构建模块，用于建立考虑未知扰动的多关节刚性机械臂动力学系统数学模型，同时建立机械臂传感器故障和机械臂执行器故障的数学模型；

10、控制器设计模块，用于设计考虑传感器和执行器故障的机械臂有限时间自适应容错控制器，将系统输出在有限时间内约束到期望位置的小邻域范围内，同时保证所有闭环信号有界；

11、稳定性评估模块，用于选取系统的lyapunov函数进行推导，证明设计的考虑传感器和执行器故障的机械臂有限时间自适应容错控制器所控制的机械臂系统lyapunov稳定；

12、以及容错控制模块，基于设计的考虑传感器和执行器故障的机械臂有限时间自适应容错控制器，实现对多关节刚性机械臂有限时间自适应容错控制。

13、此外，在上述多关节刚性机械臂有限时间自适应容错控制方法的基础上，本发明还提出了一种计算机设备，该计算机设备包括存储器和一个或多个处理器。

14、所述存储器中存储有可执行代码，所述处理器执行所述可执行代码时，用于实现上面述及的多关节刚性机械臂有限时间自适应容错控制方法的步骤。

15、此外，在上述多关节刚性机械臂有限时间自适应容错控制方法的基础上，本发明还提出了一种计算机可读存储介质，其上存储有程序。该程序被处理器执行时，用于实现上面述及的多关节刚性机械臂有限时间自适应容错控制方法的步骤。

16、本发明具有如下优点：

17、如上所述，本发明述及了一种多关节刚性机械臂有限时间自适应容错控制方法及系统。其中，本发明针对机械臂传感器和执行器故障问题提出了容错控制方法，提高了系统控制性能并保证了系统稳定性；本发明方法采用模糊逻辑系统逼近机械臂关节的未知非线性项，对系统参数的变化有较强的鲁棒性，更有利于实际应用；本发明方法采用有限时间技术与自适应相结合，将机械臂输出位置约束到期望位置的小邻域内，提高了系统控制性能。本发明能够有效减少传感器和执行器故障对控制精度的影响，有较好的位置跟踪效果，能够保证机械臂系统输出位置在有限时间内约束到指定范围内。

技术特征：

1.多关节刚性机械臂有限时间自适应容错控制方法，其特征在于，包括如下步骤：

2.根据权利要求1所述的多关节刚性机械臂有限时间自适应容错控制方法，其特征在于，

3.根据权利要求2所述的多关节刚性机械臂有限时间自适应容错控制方法，其特征在于，

4.根据权利要求3所述的多关节刚性机械臂有限时间自适应容错控制方法，其特征在于，

5.根据权利要求1所述的多关节刚性机械臂有限时间自适应容错控制方法，其特征在于，

6.根据权利要求1所述的多关节刚性机械臂有限时间自适应容错控制方法，其特征在于，

7.根据权利要求1所述的多关节刚性机械臂有限时间自适应容错控制方法，其特征在于，

8.一种多关节刚性机械臂有限时间自适应容错控制系统，其特征在于，包括：

9.一种计算机设备，该计算机设备包括存储器和一个或多个处理器；其特征在于，

10.一种计算机可读存储介质，其上存储有程序；其特征在于，该程序被处理器执行时，用于实现上述权利要求1至7任一项所述的多关节刚性机械臂有限时间自适应容错控制方法的步骤。

技术总结
本发明属于刚性机械臂位置跟踪控制技术领域，具体公开了一种多关节刚性机械臂有限时间自适应容错控制方法及系统。本发明针对机械臂出现的传感器和执行器故障、参数不确定性和外界干扰等问题，通过自适应技术对传感器和执行器故障的失效程度进行估计；本发明利用log型障碍李雅普诺夫函数对系统进行状态误差约束；本发明利用模糊逻辑系统逼近机械臂关节的未知非线性项和未知扰动；此外，本发明还设计自适应控制律和有限时间控制器实现对故障的容错控制。本发明能够有效减少传感器和执行器故障对控制精度的影响，有较好的位置跟踪效果，能够保证系统输出位置在有限时间内约束到指定范围内。

技术研发人员：于金鹏,王保防,刘加朋,陈海亭,杨伟,宿俊浩,刘浩东
受保护的技术使用者：青岛大学
技术研发日：
技术公布日：2024/1/15