基于自抗扰和反演技术的单臂机械手控制器及其设计方法技术

本发明专利技术公开了基于自抗扰和反演技术的单臂机械手控制器及其设计方法。以单臂机械手为被控对象、输出位置信号为被控变量，考虑输入限幅和控制精度等因素，所述的控制器结构由2个子控制器组成，第1子控制器输出的端与第2子控制器的输入端相连，第2子控制器的输出端与单臂机械手的输入端连接。本发明专利技术利用扩张状态观测器不依赖系统模型的特点，实时估计并补偿建模误差的影响；设计辅助系统处理控制量限幅问题；进一步，采用预定义跟踪性能函数来改善收敛的精度与速度。在保证系统稳定的基础上，提出的含辅助系统和预定义性能函数的单臂机械手控制器能够使系统输出信号跟踪期望轨迹，并能有效处理系统不确定性、提高系统的收敛精度与速度等问题。

【技术实现步骤摘要】
基于自抗扰和反演技术的单臂机械手控制器及其设计方法
本专利技术属于工业过程控制
，具体涉及基于自抗扰和反演技术的单臂机械手控制器及其设计方法。
技术介绍
工业机械手是近代自动控制领域中出现的一项新技术，并已成为一门新兴的学科——机械手工程。在单臂机械手中，机械手的关节角位移是其自身一个重要输出的量，是实际系统中经常需要的控制量。在很多的实际生产中，受驱动系统功率的限制，单臂机械手的速度、角速度必然会有一定的上限，从而使控制量具有饱和特性。该特性对系统的跟踪误差和稳定性都有影响，在2010年，陈谋提出了采用辅助系统对控制量的输入饱和特性进行处理。而本专利技术在控制器的设计中，利用在反演设计的每一步中都嵌入自抗扰技术(ActiveDisturbanceRejectionControl)，该控制器凭借其设计过程简单，使其对单臂机械手控制的研究具有最直接的现实意义。自抗扰技术是由韩京清先生提出的，其核心是把被控对象化为简单的“积分串联型”来控制，把对象中异于“积分串联型”的部分当成“总扰动”来进行处理。在ADRC技术诞生之初，由于控制器中扩张状态观测器(Extendedstateobserver,ESO)收敛性和稳定性等问题一直未被普及，直到黄一等人从“自稳定域”的角度分析了二阶ESO的估计误差及其收敛性，二阶ADRC的相关分析才得到进一步完善与普及。其中跟踪微分器(Trackingdifferentiator,TD)使得在经典意义下不可微的函数却有其广义导数，而ESO不仅可以一致地逼近系统中的不确定项，并且能估计出系统中的未知状态，并能有效的抑制系统中的扰动。自抗扰控制技术最初被应用于工业，尤其在二阶ADRC完善后，其被广泛的应用在电机控制、飞行控制、机器人控制等工业控制系统中。在2009年，KPTee提出了针对n阶仿射非线性系统选取非对称李雅普诺夫函数使系统的跟踪误差在上下限为不同恒值的集内；在2016年，王敏利用预定义跟踪性能函数使系统的收敛速度加快、收敛精度变小、跟踪误差始终处于预定义函数的界内；在2014年，程春华提出了针对非仿射非线性系统，在每一个子系统中利用自抗扰技术进行反演设计；在2016年，冉茂鹏在利用自抗扰技术的基础上，采用动态反演技术设计了使系统镇定的控制律。在实际的应用中，对单臂机械手控制时，无法避免系统中的不确定项和扰动对控制性能的影响；以及被控对象对自身的力矩固有的限幅特性，即输入饱和的问题；和收敛精度与速度偏大，无法达到精准控制的难题。
技术实现思路
本专利技术根据现用
技术介绍
的不完善与不足，基于自抗扰和反演技术对单臂机械手位置实现控制，在每一个子系统中采用自抗扰技术设计反演控制技术，利用扩张状态观测器不依赖系统模型的特点，实时估计并补偿建模误差的影响；设计辅助系统处理控制量限幅问题；进一步，采用预定义跟踪性能函数来改善收敛的精度与速度。在保证系统稳定的基础上，解决了系统不确定性、输入饱和、收敛精度与速度偏大的难题。为了实现以上的技术目的，本专利技术将采取以下技术方案：基于自抗扰和反演技术的单臂机械手控制器，以单臂机械手为被控对象，包括第1子控制器和第2子控制器，单臂机械手的输出端分别与第1子控制器和第2子控制器相连，第1子控制器输出的端与第2子控制器的输入端相连，第2子控制器的输出端与单臂机械手的输入端连接，第1子控制器包括第一比较器单元、第一扩张状态观测器单元、预定义跟踪性能函数及其参数设置单元和第一非线性运算单元；第一比较器单元的两个输入端分别为期望信号yd和系统输出转角x1；第一扩张状态观测器单元的两个输入端分别为第一比较器单元输出差e1和机械手角速度x2；第一非线性运算单元的三个输入端分别为第一比较器单元输出差e1、预定义跟踪性能函数及其参数设置单元的输出端和第一扩张状态观测器单元输出的z1,2，经第一非线性运算单元运算得到虚拟控制x2d；第2子控制器包括第二比较器单元、第三比较器单元、跟踪微分器单元、辅助系统单元、第二扩张状态观测器单元和第二非线性运算单元；第1子控制器输出的x2d与跟踪微分器单元相连；第1子控制器输出的x2d和机械手角速度x2作为第二比较器单元的两个输入；跟踪微分器单元的输入端与第1子控制器输出的x2d相连；第二非线性运算单元的六个输入端分别为第一比较器单元输出差e1、第二比较器单元输出差e2、预定义跟踪性能函数及其参数设置单元输出端、跟踪微分器单元输出的v1,2、第二扩张状态观测器单元输出的z2,2和辅助系统单元输出的ξ，经第二非线性运算单元运算得到控制律uc；控制律uc经计算得到饱和特性输出u；跟踪微分器单元输出的v1,2、第二比较器单元输出差e2和饱和特性输出u作为第二扩张状态观测器单元的三个输入；第二非线性运算单元输出的uc和饱和特性输出u作为第三比较器单元的两个输入；第三比较器单元输出的Δu与辅助系统单元相连。基于自抗扰和反演技术的单臂机械手控制器的控制方法，被控对象为单臂机械手，其系统模型为：其中，θ为系统输出转角；D0＝4ml2/3为转动惯量；C0为关节转到的粘性摩擦系数；G0＝mglcosθ为机械手的重力项；τ是单臂机械手的力矩，也是控制量；dis为干扰量,m为机械手质量，l为质心距连杆转动中心的距离；g为重力加速度；对单臂机械手输出位置控制的状态模型是：式中，x1＝θ，θ为系统输出转角，x2＝ω，ω为机械手角速度；y为输出位置信号，u＝τ是单臂机械手的力矩，由于单臂机械手对自身的力矩固有的限幅特性，第2子控制器输出的控制律uc经过以下公式的计算得到饱和特性输出u，u为被控对象的输入：其中，uc为第二非线性运算单元输出的控制律，umax∈(0,∞)，umin∈(-∞,0)。基于自抗扰和反演技术的单臂机械手控制器的设计方法，包括以下步骤：A、第1子控制器的设计：A1、第一比较器单元的设计：第一比较器单元的两个输入端分别为期望信号yd和系统输出转角x1，经过以下公式的计算得到第一比较器单元输出差e1：e1＝x1-yd；A2、第一扩张状态观测器单元的设计：第一扩张状态观测器单元的两个输入端分为第一比较器单元输出差e1和机械手角速度x2，经过以下公式的计算得到第一扩张状态观测器单元输出信号z1,2：其中，E1为第一扩张状态观测器的估计误差，z1,1为第一扩张状态观测器的内部变量，β1、β2均是第一扩张状态观测器的增益，c2∈(0,∞)为待设计的参数，α1∈(0,1)是可调参数，sign(*)是符号函数，表达式为：A3、预定义跟踪性能函数及其参数设置单元的设计：预定义跟踪性能函数的形式如下：μ(t)＝(μ0-μ∞)exp(-kct)+μ∞；使得-ρ1μ(t)<e1(t)<ρ2μ(t)，对恒成立，式中，t为时间，kc为正常数，μ0>0为μ(t)的初始值，且μ∞>0，ρ1,ρ2∈(0,1]，且满足-ρ1μ(0)<e1(0)<ρ2μ(0)；A4、第一非线性运算单元的设计：第一非线性运算单元的三个输入端分别为第一比较器单元输出差e1、预定义跟踪性能函数及其参数设置单元输出和第一扩张状态观测器单元输出z1,2，经过以下公式的计算得到虚拟控制x2d：式中，c2∈(0,∞)和ρ1,ρ2∈(0,1]均为待设计的参数，B、第2本文档来自技高网...

【技术保护点】
基于自抗扰和反演技术的单臂机械手控制器，以单臂机械手为被控对象，包括第1子控制器和第2子控制器，单臂机械手的输出端分别与第1子控制器和第2子控制器相连，第1子控制器输出的端与第2子控制器的输入端相连，第2子控制器的输出端与单臂机械手的输入端连接，其特征在于：第1子控制器包括第一比较器单元、第一扩张状态观测器单元、预定义跟踪性能函数及其参数设置单元和第一非线性运算单元；第一比较器单元的两个输入端分别为期望信号yd和系统输出转角x1；第一扩张状态观测器单元的两个输入端分别为第一比较器单元输出差e1和机械手角速度x2；第一非线性运算单元的三个输入端分别为第一比较器单元输出差e1、预定义跟踪性能函数及其参数设置单元的输出端和第一扩张状态观测器单元输出的z1,2，经第一非线性运算单元运算得到虚拟控制x2d；第2子控制器包括第二比较器单元、第三比较器单元、跟踪微分器单元、辅助系统单元、第二扩张状态观测器单元和第二非线性运算单元；第1子控制器输出的x2d与跟踪微分器单元相连；第1子控制器输出的x2d和机械手角速度x2作为第二比较器单元的两个输入；跟踪微分器单元的输入端与第1子控制器输出的x2d相连；第二非线性运算单元的六个输入端分别为第一比较器单元输出差e1、第二比较器单元输出差e2、预定义跟踪性能函数及其参数设置单元输出端、跟踪微分器单元输出的v1,2、第二扩张状态观测器单元输出的z2,2和辅助系统单元输出的ξ，经第二非线性运算单元运算得到控制律uc；控制律uc经计算得到饱和特性输出u；跟踪微分器单元输出的v1,2、第二比较器单元输出差e2和饱和特性输出u作为第二扩张状态观测器单元的三个输入；第二非线性运算单元输出的uc和饱和特性输出u作为第三比较器单元的两个输入；第三比较器单元输出的Δu与辅助系统单元相连。...

【技术特征摘要】
1.基于自抗扰和反演技术的单臂机械手控制器，以单臂机械手为被控对象，包括第1子控制器和第2子控制器，单臂机械手的输出端分别与第1子控制器和第2子控制器相连，第1子控制器输出的端与第2子控制器的输入端相连，第2子控制器的输出端与单臂机械手的输入端连接，其特征在于：第1子控制器包括第一比较器单元、第一扩张状态观测器单元、预定义跟踪性能函数及其参数设置单元和第一非线性运算单元；第一比较器单元的两个输入端分别为期望信号yd和系统输出转角x1；第一扩张状态观测器单元的两个输入端分别为第一比较器单元输出差e1和机械手角速度x2；第一非线性运算单元的三个输入端分别为第一比较器单元输出差e1、预定义跟踪性能函数及其参数设置单元的输出端和第一扩张状态观测器单元输出的z1,2，经第一非线性运算单元运算得到虚拟控制x2d；第2子控制器包括第二比较器单元、第三比较器单元、跟踪微分器单元、辅助系统单元、第二扩张状态观测器单元和第二非线性运算单元；第1子控制器输出的x2d与跟踪微分器单元相连；第1子控制器输出的x2d和机械手角速度x2作为第二比较器单元的两个输入；跟踪微分器单元的输入端与第1子控制器输出的x2d相连；第二非线性运算单元的六个输入端分别为第一比较器单元输出差e1、第二比较器单元输出差e2、预定义跟踪性能函数及其参数设置单元输出端、跟踪微分器单元输出的v1,2、第二扩张状态观测器单元输出的z2,2和辅助系统单元输出的ξ，经第二非线性运算单元运算得到控制律uc；控制律uc经计算得到饱和特性输出u；跟踪微分器单元输出的v1,2、第二比较器单元输出差e2和饱和特性输出u作为第二扩张状态观测器单元的三个输入；第二非线性运算单元输出的uc和饱和特性输出u作为第三比较器单元的两个输入；第三比较器单元输出的Δu与辅助系统单元相连。2.根据权利要求1所述的基于自抗扰和反演技术的单臂机械手控制器的控制方法，其特征在于：被控对象为单臂机械手，其系统模型为：其中，θ为系统输出转角；D0＝4ml2/3为转动惯量；C0为关节转到的粘性摩擦系数；G0＝mglcosθ为机械手的重力项；τ是单臂机械手的力矩，也是控制量；dis为干扰量,m为机械手质量，l为质心距连杆转动中心的距离；g为重力加速度；对单臂机械手输出位置控制的状态模型是：式中，x1＝θ，θ为系统输出转角，x2＝ω，ω为机械手角速度；y为输出位置信号，u＝τ是单臂机械手的力矩，由于单臂机械手对自身的力矩固有的限幅特性，第2子控制器输出的控制律uc经过以下公式的计算得到饱和特性输出u，u为被控对象的输入：其中，uc为第二非线性运算单元输出的控制律，umax∈(0,∞)，umin∈(-∞,0)。3.根据权利要求1所述的基于自抗扰和反演技术的单臂机械手控制器的设计方法，其特征在于：包括以下步骤：A、第1子控制器的设计：A1、第一比较器单元的设计：第一比较器单元的两个输入端分别为期望信号yd和系统输出转角x1，经过以下公式的计算得到第一比较器单元输出差e1：e1＝x1-yd；A2、第一扩张状态观测器单元的设计：第一扩张状态观测器单元的两个输入端分为第一比较器单元输出差e1和机械手角速度x2，经过以下公式的计算得到第一扩张状态观测器单元输出信号z1,2：其中，E1为第一扩张状态观测器的估计误差，z1,1为第一扩张状态观测器的内部变量，β1、β2均是第一扩张状态观测器的增益，c2∈(0,∞)为待设计的参数，α1∈(0,1)是...

【专利技术属性】
技术研发人员：杨杨，谈杰，岳东，
申请(专利权)人：南京邮电大学，
类型：发明
国别省市：江苏,32