一种具有死区和时变约束功能的机械臂控制方法技术

本发明专利技术公开了一种具有死区和时变约束功能的机械臂控制方法，建立单关节机械臂的动力学模型，将动力学模型中的不确定部分与反演虚拟控制律的导数进行整合，并结合死区特性建立状态空间表达式；将单关节机械臂的执行动作划分为n步，采用RBF神经网络对每一步动作中的非线性函数进行逼近，构建每一步动作的虚拟控制律、自适应律、理想控制率；依次迭代，计算每一步动作的虚拟控制律、自适应律；以第n步的虚拟控制率和自适应率作为实际自适应控制输出信号，以实际自适应控制输出信号控制单关节机械臂动作。本发明专利技术可实现在模型不确定、具有输入死区且需满足状态不完全可测的时变全状态约束下，对单关节机械臂稳定且精确的进行自适应控制的目的。控制的目的。控制的目的。

【技术实现步骤摘要】
一种具有死区和时变约束功能的机械臂控制方法


[0001]本专利技术涉及领域，具体涉及一种具有死区和时变约束功能的机械臂控制方法。

技术介绍

[0002]机械臂轨迹跟踪控制，是通过各个关节的控制器输出驱动力矩控制各关节位置、速度等变量，从而高精度地伴随给定轨迹变化，以使机械臂实现期望理想路径的操作过程。传统控制器的设计通常采用基于被控对象模型的设计方法，通过创建机械臂动力学方程，依据传统控制理论设计控制律。
[0003]在实际应用中，由于负载质量、连杆质心、动/静摩擦力、以及环境干扰等不确定性因素，要想得到机械臂准确的数学模型十分困难，并且机械臂在运动过程中由于环境、负载等变化导致模型和参数也在随时变化，使这类方法的控制精度始终较低。另外在机械臂的实际控制过程中，在生产安全、工作空间及障碍位置等原因的限制下，往往需要限制机械臂的轨迹运动范围和运动速度，因此不仅需要对机械臂各关节位置进行限制，还需要对关节速度进行约束。
[0004]与电机驱动机械臂相比，单关节机械臂由于具有结构简单、体积小、质量轻、能耗低等特点，非常适合于装配、定位和搬运等重复性任务，且不需要考虑电机电流的约束。然而单关节机械臂由于一些零件、关节等的不灵敏或型号不适配等问题，存在输入死区现象，即系统对小的输入信号不敏感，当输入信号过小时系统没有对应的输出；并且单关节机械臂在运行过程中由于活动空间和障碍物的干扰，要求系统的控制精度极高，则存在时变约束，这导致了难以采用自适应模糊算法来针对单关节机械臂进行自适应控制。
[0005]综上，现有技术中的单关节机械臂控制方法无法同时解决机械臂控制中的模型不确定、状态不完全可测、输入死区、时变全状态约束，以及自适应性差等问题，并且还存在由于计算量大导致控制滞后的缺陷。

技术实现思路

[0006]本专利技术提供一种具有死区和时变约束功能的机械臂控制方法，以解决现有技术中单关节机械臂控制技术无法同时解决模型不确定、状态不完全可测、输入死区、时变全状态约束、自适应性差等问题，实现在模型不确定、具有输入死区且需满足状态不完全可测的时变全状态约束下，对单关节机械臂稳定且精确的进行自适应控制的目的。
[0007]本专利技术通过下述技术方案实现：
[0008]一种具有死区和时变约束功能的机械臂控制方法，包括：
[0009]建立单关节机械臂的动力学模型，将所述动力学模型中的不确定部分与反演虚拟控制律的导数进行整合，并结合死区特性建立状态空间表达式；
[0010]基于状态空间表达式的动态面控制，将单关节机械臂的执行动作划分为n步，采用RBF神经网络对每一步动作中的非线性函数进行逼近，构建每一步动作的虚拟控制律、自适应律、理想控制率；
[0011]依次迭代，计算每一步动作的虚拟控制律、自适应律；
[0012]以第n步的虚拟控制率和自适应率作为实际自适应控制输出信号，以所述实际自适应控制输出信号控制单关节机械臂动作。
[0013]针对现有技术中对单关节机械臂的控制过程，无法同时解决模型不确定、状态不完全可测、输入死区、时变全状态约束、自适应性差等问题，本专利技术提出一种具有死区和时变约束功能的机械臂控制方法，本方法专用于单关节机械臂的控制。
[0014]本方法首先创建单关节机械臂的动力学模型，然后将动力学模型中的不确定部分与反演虚拟控制律的导数进行整合，再结合死区特性得到本申请所需的状态空间表达式。通过本方法所得到的状态空间表达式：（1）克服了由于负载质量、连杆质心、动/静摩擦力、以及环境干扰等不确定性因素所导致的模型不确定缺陷、解决了未知控制增益等多种不确定问题；（2）能够避免传统反演设计中反复求导造成的“复杂性爆炸”问题，显著降低了控制算法的复杂性和计算量，有利于提高控制的实时性；（3）能够有效解决单关节机械臂中输入死区非线性而带来的控制难题。
[0015]之后，本申请基于状态空间表达式将单关节机械臂的执行动作划分为n步，并采用RBF神经网络对每一步动作中的非线性函数进行逼近，即是依次对n步动作逐步的采用RBF神经网络进行迭代逼近，计算出每一步动作的虚拟控制率、自适应率，以第n步（即最后一步）的虚拟控制率和自适应率作为实际自适应控制输出信号，来控制单关节机械臂的动作。本申请通过将机械臂的执行动作划分为n步，并采用RBF神经网络逐步依次迭代计算的方式，能够有效逼近机械臂动力学模型中的不确定部分，保证机械臂各状态变量不超过相应的规定限制范围、从而满足输入死区、全状态约束（包括轨迹运动范围、运动速度、关节速度）和时变约束的限制。本申请具有良好的适应性、鲁棒性和抗干扰能力，同时控制精度很高，计算量相对现有技术更小，对于单关节机械臂系统的控制而言具有较高的实际应用价值。
[0016]进一步的，建立的状态空间表达式为：
[0017]式中，x1、x2均为状态变量；、分别为x1、x2关于时间的导数；y为单关节机械臂输出轨迹；t为时间变量；u(D)为具有死区特性的输出力矩；v为理想控制律；D(v)为输入
死区特性；g
l
、g
r
分别为死区特性的左斜率、右斜率；b
l
、b
r
分别为左截距、右截距，且b
l
＜0，b
r
＞0；J为机械臂的转动惯量；F
d
为摩擦模型，k1、k2均为正常数；ζ1(t)、ζ2(t)均为有界扰动；m为单关节机械臂连轴重量；g为重力加速度；l为单关节机械臂连轴长度；θ为单关节机械臂的旋转角速度，为单关节机械臂下一时刻的角速度；sgn表示符号函数；为θ关于时间的导数；k1为黏性摩擦参数；k2为库仑摩擦参数；d为单关节机械臂的高度。
[0018]本方案给出了整合单关节机械臂动力学模型中不确定部分与反演虚拟控制律的导数，并结合死区特性所建立的状态空间表达式的具体形式，填补了现有技术的空白。
[0019]进一步的，所述RBF神经网络中，神经网络高斯基函数为：
[0020]式中，σ
i
(x)表示第i步的高斯基函数；x为神经网络的输入向量；exp表示以自然对数为底的指数运算符；c
i
为隐含层的中心节点；b
i
为高斯基函数的宽度。
[0021]基于所述RBF神经网络高斯基函数，得到第i步的神经网络结构为：
[0022]；
[0023]式中，y为神经网络输出；W
i
为第i步的神经网络权值向量；
[0024]采用RBF神经网络对每一步动作中的非线性函数进行逼近的过程中，采用的未知函数为：
[0025]f
i
(X
i
) = W
i*T
σ
i
(X
i
)+ε
i*
(X
i
)；
[0026]式中，f
i
(X
i
)为第i步的未知函数；W
i*<本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种具有死区和时变约束功能的机械臂控制方法，其特征在于，包括：建立单关节机械臂的动力学模型，将所述动力学模型中的不确定部分与反演虚拟控制律的导数进行整合，并结合死区特性建立状态空间表达式；基于状态空间表达式的动态面控制，将单关节机械臂的执行动作划分为n步，采用RBF神经网络对每一步动作中的非线性函数进行逼近，构建每一步动作的虚拟控制律、自适应律、理想控制率；依次迭代，计算每一步动作的虚拟控制律、自适应律；以第n步的虚拟控制率和自适应率作为实际自适应控制输出信号，以所述实际自适应控制输出信号控制单关节机械臂动作。2.根据权利要求1所述的一种具有死区和时变约束功能的机械臂控制方法，其特征在于，建立的状态空间表达式为：；；；；式中，x1、x2均为状态变量；、分别为x1、x2关于时间的导数；y为单关节机械臂输出轨迹；t为时间变量；u(D)为具有死区特性的输出力矩；v为理想控制律；D(v)为输入死区特性；g
l
、g
r
分别为死区特性的左斜率、右斜率；b
l
、b
r
分别为左截距、右截距，且b
l
＜0，b
r
＞0；J为机械臂的转动惯量；F
d
为摩擦模型，k1、k2均为正常数；ζ1(t)、ζ2(t)均为有界扰动；m为单关节机械臂连轴重量；g为重力加速度；l为单关节机械臂连轴长度；θ为单关节机械臂的旋转角速度，为单关节机械臂下一时刻的角速度；sgn表示符号函数；为θ关于时间的导数；k1为黏性摩擦参数；k2为库仑摩擦参数；d为单关节机械臂的高度。3.根据权利要求1所述的一种具有死区和时变约束功能的机械臂控制方法，其特征在于，所述RBF神经网络中，神经网络高斯基函数为：；式中，σ
i
(x)表示第i步的高斯基函数；x为神经网络的输入向量；exp表示以自然对数为底的指数运算符；c
i
为隐含层的中心节点；b
i
为高斯基函数的宽度。4.根据权利要求3所述的一种具有死区和时变约束功能的机械臂控制方法，其特征在于，
所述RBF神经网络中，第i步的神经网络结构为：y=W
iT
σ
i
(x)；式中，y为神经网络输出；W
i
为第i步的神经网络权值向量；采用RBF神经网络对每一步动作中的非线性函数进行逼近的过程中，采用的未知函数为：f
i
(X
i
) = W
i*T
σ
i
(X
i
)+ε
i*
(X
i
)；式中，f
i
(X
i
)为第i步的未知函数；W
i*
为第i步的神经网络最佳权值向量，ε
i*
(X
i
)为第i步的最小逼近误差；T为转置运算符；X
i
为x的矩阵；σ
i
(X
i
)表示矩阵X
i
所对应的高斯基函数。5.根据权利要求1所述的一种具有死区和时变约束功能的机械臂控制方法，其特征在于，得到每一步动作的虚拟控制律、自适应律的方法包括：确定当前动作属于划分后的第i步，i=1,2,
…
,n；定义误差函数，所述误差函数包括跟踪误差或虚拟误差；计算滤波误差；设置时变非对称障碍李亚普洛夫函数；选择时变约束边界，并将误差函数坐标化，计算障碍李亚普洛夫函数关于时间的导数；引入ReLU函数对输入死区特性进行逼近补偿，同时结合He初始化使输入和输出均服从相同的高斯分布；基于杨氏不等式对障碍李亚普洛夫函数关于时间的导数进行变形，得到虚拟控制律、自适应律。6.根据权利要求5所述的一种具有死区和时变约束功能的机械臂控制方法，其特征在于，所述输入死区特性为：；；；式中，D(v)为输入死区特性；v为理想控制律；K(t)为输入死区线性部分的斜率；d(v)为输入死区的非线性部分；g
l
、g
r
分别为死区特性的左斜率、右斜率；b
l
、b
r
分别为左截距、右截距，且b
l
＜0，b
r
＞0。7.根据权利要求5所述的一种具有死区和时变约束功能的机械臂控制方法，其特征在于，所述ReLU函数为：Relu=max(0,x)；式中，Relu表示ReLU函数；x为神经网络的输入向量；使输入和输出均服从的高斯分布为：N(0, σ
12
)；其中，，σ1为高斯分布的标准差；J为机械臂的转动惯量；M
l
为第l...

【专利技术属性】
技术研发人员：万敏，梁颖，张强，许海英，
申请(专利权)人：西南石油大学，
类型：发明
国别省市：