基于四元数的冗余机械臂抗推绕姿态控制方法

技术领域

本发明属于机械臂控制技术领域，涉及基于四元数的冗余机械臂抗推绕姿态控制方法。

背景技术

由于指向精度高、快速响应、鲁棒性强等机械臂控制任务的要求越来越具有挑战性，机械臂控制器设计已成为研究热点。多自由度为冗余操纵器创造了核心优势，以实现比非冗余操纵器更复杂的任务。由于这种冗余性，冗余机械手得到了广泛的研究，包括避障、重复运动产生和合作运动产生等方面的深入研究。冗余机械手的许多成就和功能已经实现并应用于服务和制造业。冗余机械手的冗余分析相当于一个优化问题，因为对于一个给定的任务来说，冗余分析具有无限的解决属性。

优化问题的建模方法和解决策略直接决定了机械手的功能和效率。现有的文章针对机械臂控制问题，提出了各种控制方案，如比例积分微分(PID)控制律、线性参数变化(LPV)增益调度控制器、模糊控制方法等。尽管有了这些成效，冗余机械臂的姿态机动控制仍然具有挑战性。滑动模式控制(SMC)是一种非线性控制技术，它通过应用不连续控制律(或更严格地说，是集值控制信号)来改变非线性系统的动力学，该控制律迫使系统沿着系统正常行为的横截面滑动。这种控制技术首次被提出用于可变结构系统。随后，由于其较强的鲁棒性，它在处理机械臂控制方面引起了广泛的关注。由于不连续符号函数的存在，传统的SMC控制器存在颤振问题。为了减轻这种不良的性能，符号函数被近似为饱和函数。在已有文章中，引入了一个边界层来解决抖振问题，将不连续符号函数引入到控制输入的一阶导数中，然后给出了一个无颤振的高阶积分SMC。此外，SMC技术还与其他控制方法相结合，可以提高自适应控制方法等机械臂姿态控制系统的性能。

上述方法的一个典型特征是，当用四元数描述机械臂姿态时，其优点是无奇异，无超越函数运算，可用于连续旋转表示，但是缺点为存在一个冗余，存在退绕现象，不直观。四元数具有双覆盖性质，因此对于刚体的给定物理姿态有两种数学表示。因此，存在两个平衡点[1 0 0 0]

发明内容

为了克服上述现有技术的不足，本专利提出了一种基于四元数的冗余机械臂抗推绕姿态控制方法,进而保证机械臂闭环系统在边界层内的反展开性能和收敛性。

本发明所采用的技术方案是：

步骤1，利用四元数方法对电缆机械臂建立数学模型；

步骤2，基于姿态动力学进行误差设计，获得误差四元数；

步骤3，通过双曲正弦函数设计了一个新的基于误差四元数的开关函数，使开关面包含两个平衡点；

步骤4，基于所提出的开关函数开发了一个滑动模式姿态机动控制器，以确保闭环系统对扰动和惯性不确定性的鲁棒性。

进一步的，步骤1的具体实现方式如下；

微分运动学给出了关节速度与相应的端效应器线速度和角速度之间的关系，机械臂的微分运动学方程可表示为：

其中

进一步的，步骤2的具体实现方式如下；

姿态误差设计：设

其中

根据(4)，误差四元数q

通过对(5)的导数，得到了以下姿态误差运动学：

其中，

ω

其中R为从F

旋转矩阵R满足

姿态误差动力学：对于一个静止到静止的姿态机动控制问题，所期望的姿态速度满足ω

此外，考虑惯性不确定度，即J＝J

然后，通过(6)和(11)，设计相对姿态误差的姿态动力学方程为，

此外，误差四元数也可以写成：

其中，θ(t)∈[0,2π]为旋转角，

θ(t)＝2arccos q

从(4)和(13)的第一个关系中可得出：

根据(3)，只要给出q的初始姿态q(0)和期望的姿态q

进一步的，步骤3中设计的开关函数如下；

s＝w

其中λ为正常数，并且

σ＝sinh(q

函数cosh q

进一步的，步骤5中需要构造一个控制律，即滑动模式姿态机动控制器，使其满足条件ss

根据机械臂的姿态误差动力学(13)的状态反馈控制，

u＝u

其中u

其中，

姿态误差动力学(13)的标称部分为：

控制项u

u

其中γ

然后，提出了以下抗推绕滑模姿态控制律：

其中λ、γ

与现有技术相比，本发明具有以下有益效果：

本发明能避免退绕现象，并对扰动和惯性的不确定性进行了补偿，消除了震颤振问题，更适用于实际工程应用。本发明提出了一个包含两个平衡点的新的开关函数，通过选择一个由双曲余弦函数构造的李雅普诺夫函数，证明了系统状态在开关面上时的反展开性能。其次，设计了滑模控制律，保证系统轨迹被切换面吸引。此外，通过设计一个滑模控制律的动态参数，证明了当系统状态在开关面外时的反展开性能。第三，通过为开关表面引入边界层来避免颤振现象，如果选择所设计的开关面的参数来满足一定的条件，可以保证机械臂闭环系统在边界层内的反展开性能和收敛性。

具体实施方式

下面结合具体实施步骤对本发明的技术方案做进一步详细的说明。

步骤一，利用四元数对系统模型进行建模，以及用数学合理表达要解决的问题

1.1系统模型

微分运动学给出了关节速度与相应的端效应器线速度和角速度之间的关系，机械臂的微分运动学方程可表示为

其中

此外，对于任何向量m＝[m

基于姿态动力学，下一节给出了自身框架F

姿态误差设计：设

其中

根据(4)，误差四元数q

通过对(5)的导数，我们得到了以下姿态误差运动学

其中，

ω

其中R为从F

旋转矩阵R满足

姿态误差动力学：对于一个静止到静止的姿态机动控制问题，所期望的姿态速度满足ω

此外，本文考虑了惯性不确定度，即J＝J

然后，通过(6)和(11)，相对姿态误差的姿态动力学为，

此外，误差四元数也可以写成

其中，θ(t)∈[0,2π]为旋转角，

θ(t)＝2arccos q

从(4)和(13)的第一个关系中可以得出

根据(3)，只要给出q的初始姿态q(0)和期望的姿态q

1.2退绕现象

鉴于机械臂内部关系，有q

1.3控制目标

本工作的控制任务是设计一种抗退绕姿态控制器，以实现机械臂的静止-静止姿态操纵。通过采用设计的控制律，对于机械臂的闭环姿态机动误差动力学，实现以下关系：

此外，在机械臂机动过程中，避免了退绕现象。

步骤二，针对要解决的问题，设计合适的滑膜面和控制方案

2.1开关滑膜面

对于机械臂的姿态误差动力学，我们设计了以下开关函数

s＝w

其中λ为正常数并且

σ＝sinh(q

然后，给出了一个定理，证明当系统状态限制在开关面S＝0时，实现了控制目标。在给定这个定理之前，我们应该给出函数cosh q

理论2：如果姿态误差动力学的系统状态仅限于开关面s＝0，则可以得出以下结论。

(i)角速度误差ω

(ii)避免了退绕现象。

证明：首先，我们选择以下的李雅普诺夫函数。

V

其中κ＝max(cosh q

显然

此外，还可以从(22)中得到：

此外，对于任何较小的正值ε，它可以从(23)得到

接下来，证明了系统状态在开关表面S＝0上的姿态误差动力学的反展开性能。根据(15)，李亚普诺夫函数可以转化为

且

这意味着当系统状态被限制在开关面s＝0时，避免了展开现象。

2.2姿态控制律

在本节中，我们需要构造一个控制律，使其满足条件ss

考虑一类针对刚性航天器的姿态误差动力学(13)的状态反馈控制，

u＝u

其中u

其中，

姿态误差动力学(13)的标称部分为

控制项u

u

其中γ

然后，提出了以下抗推绕滑模姿态机动控制定律

其中λ、γ

2.3收敛性分析

在本节中，首先给出定理3，分析了闭环系统在定律下当系统状态在滑动面之外时的收敛性能和反展开特性。此外，通过在式中引入不连续函数f(s)的边界层，提出了具有连续控制体系结构的机械臂抗推绕姿态控制定律。此外，给出了定理4，说明了该系统在连续奥斯马克定律下，该系统在边界层内的无展开性和收敛性。

定理3：考虑在假设下描述的机械臂和提出的AUSMAMC定律。我们得出了以下结论。

(i)开关函数s在有限时间内收敛于0。

(ii)如果选择提议的标准定律的参数γ

其中g＝sinh(q

证明：为了证明结论(i)，我们选择了以下李亚普诺夫函数

在上述帮助下，我们从(33)中可得

将奥斯曼克定律替换(34)，为

从(30)得出，||s||≠0时存在以下关系

通过将其与上述结合起来，很容易得到

显然，

接下来，通过设计动态参数γ

鉴于上式，可推导出

假设初始时间为t

直接计算给出

从上述关系中可以得出

注意，

结合上述，得出

此外，还可转化为

需要注意的是，本文考虑了静止到静止的姿态机动问题。因此，ω

v(0)＝λg(0) (46)

此外，在上述的帮助下，我们得到V2(0)的初始值为(ω

因此，可以从已知式子中得出以下关系

这可以进一步写成

假设t

(a)当θ(0)∈(0,π]时，通过(14)的第一个方程，我们有q

v(0)＝λsinh(q

因此，对于t∈[0,t

可以进一步转化为

如果

(b)当θ(0)∈(π,2π)时，通过已知方程，我们有q

因此，对于t∈[0,t

同理可得

可知

在定理3(ii)中，在系统状态到达开关面之前，已经证明了其反展开性能。在定理2(ii)中，当系统状态在开关表面上被收缩时，其反展开性能也得到了证明。这两个定理的结果表明，闭环系统(13)根据该定律(36)和(35)具有反展开的性能。

备注2：所提出的机械臂抗推绕姿态控制的一个缺点是它对开关面的＝0是不连续的。这种特性可能会引起不希望出现的颤振现象。对于实际的实现，控制器必须被平滑处理。因此，为其中函数f(s)的s＝0引入了一个边界层ε，从而使

其中，ε是一个很小的正值。当ε趋近于零时，该边界层的性能可以任意地接近于原始控制律的性能。

因此，根据定理3，以下结论适用于AUSMAMC定律。

(i)(20)中的开关函数s在有限时间内收敛于边界层||s||＞ε，其中λ是一个很小的正值。

(ii)如果选择参数γ

定理4：考虑||s||≤ε假设1下描述的机械臂，如果选择AUSMAMC定律的参数γ

其中ε和ε1为较小的正数，则避免了展开现象。此外，ωe和qev分别收敛于区域

证明：根据(50)、(58)和||s||≤ε的关系，我们得到了

此外，考虑到(38)和(14)，我们有

然后考虑以下情况来完成证明。

如果为θ(t)∈(0,π)

因此，所提出的机械臂抗推绕姿态控制能避免退绕现象，并对扰动和惯性的不确定性进行了补偿。此外，该方法消除了震颤振问题，更适用于实际工程应用。