CN114643583B - 一种冗余机械臂奇异点规避方法 - Google Patents

Abstract

本发明涉及一种冗余机械臂奇异点规避方法，包括：通过对冗余机械臂雅克比矩阵降维，构建雅克比方阵J_q；推导雅克比方阵J_q的奇异因子k_i，并利用逼近阻尼倒数方法，求解雅克比方阵J_q的逆矩阵；通过雅克比方阵J_q的逆矩阵求解冗余机械臂的逆运动学通解和特解利用优化的梯度投影算法，求解冗余机械臂的逆运动学加权项得到冗余机械臂的逆运动学实现冗余机械臂的奇异点规避。本发明利用雅克比矩阵变化和优化的梯度投影方法实现了冗余度机械臂的奇异规避，有较高的实时性能，满足工业计算实时需求；本发明求解冗余机械臂逆运动学，有效提高了机械臂在奇异点附近的轨迹精度，能够满足冗余度机械臂的工业用途需求。

Description

一种冗余机械臂奇异点规避方法

技术领域

本发明涉及冗余机械臂控制技术领域，尤其是一种冗余机械臂奇异点规避方法。

背景技术

随着轴数的增加，冗余机械臂的灵活性也随之增长，可以躲避某些特定的目标，便于末端执行器到达特定的位置，也可以更加灵活的适应某些特殊工作环境。未来，在需要高灵活性的3C产业，冗余机械臂将拥有用武之地，随着其精度不断增加，在不远的将来，它将取代人工进行装配手机等精密电子产品。

冗余机械臂的优势包含以下几个方面：(1)冗余机械臂可以避免奇异构型，可以避免角速度运动过快，让角速度分配得比较均匀；(2)改善动力学特性，可以利用其结构实现最佳的动力学性能；(3)容错性机器人在发生故障时，如果有一关节失效，传统六轴机械臂便无法继续完成工作，而冗余机械臂可以通过重新调整故障关节速度和故障关节力矩的再分配实现继续正常工作。

相对于6自由度机械臂而言，冗余机械臂具有灵活度更高和避障性能更好等多方面的优点，但是其运动学求解问题比较复杂。为了处理奇异性问题，一般采用阻尼最小二乘法DLS方法或奇异鲁棒算法经常出现使用。最近，Colome和Torras总结了使用较多的冗余机械臂闭环逆运动学分析方法，分析了其主要性能。他们还提出了一种新的奇异值滤波SVF算法，保证雅克比矩阵条件的稳定。然而,这些方法要么具有较大的计算负载或不能用于非球腕机械手，因为它们被提议用于简单的机械臂。

因此，降低冗余机械臂运动学求解复杂度，提高冗余机械臂奇异点规避过程中的末端精度具有重大的研究意义。

发明内容

本发明的目的在于提供一种具有较高的实时性，提高了冗余机械臂在奇异点附近的轨迹精度的冗余机械臂奇异点规避方法。

为实现上述目的，本发明采用了以下技术方案：一种冗余机械臂奇异点规避方法，该方法包括下列顺序的步骤：

(1)通过对冗余机械臂雅克比矩阵降维，构建雅克比方阵J_q；

(2)推导雅克比方阵J_q的奇异因子k_i，并利用逼近阻尼倒数方法，求解雅克比方阵J_q的逆矩阵J_q ^-1；

(3)通过雅克比方阵J_q的逆矩阵J_q ^-1求解冗余机械臂的逆运动学通解和特解/>

(4)利用优化的梯度投影算法，求解冗余机械臂的逆运动学加权项得到冗余机械臂的逆运动学/>实现冗余机械臂的奇异点规避。

所述步骤(1)具体是指：首先，计算冗余机械臂第五个关节的坐标系下的雅克比矩阵⁵J∈R(6×7),并将冗余机械臂第五个关节的坐标系下的雅克比矩阵的所有行和列重新排列组合，使得变换后的矩阵J′中的右上角矩阵为零矩阵，如下式所示：

其中，j_l∈R(6×1)为雅克比矩阵⁵J的第l列；J₁₁,J₂₁,J₂₂∈R(3×3)为雅克比⁵J的子矩阵；雅克比方阵J_q是指将雅克比矩阵⁵J中的除j_l之外的所有列组合在一起构成的6×6的方形矩阵。

在步骤(2)中，所述推导雅克比方阵J_q的奇异因子k_i是指将雅克比子矩阵J₁₁,J₂₂的行列式作为机械臂的奇异因子ki；所述利用逼近阻尼倒数方法，求解雅克比方阵J_q的逆矩阵J_q ^-1为：首先根据矩阵变换方法，将雅克比方阵J_q的逆矩阵表示为奇异因子k_i的倒数的函数；然后利用逼近阻尼倒数代替奇异因子k_i的倒数，求解出雅克比方阵J_q的逆矩阵J_q ^-1。

在步骤(3)中，所述求解冗余机械臂的逆运动学通解和特解/>的公式为：

其中，为冗余机械臂末端速度。

在步骤(4)中，所述优化的梯度投影算法为：

首先，定义优化目标函数H_k如下：

然后，求优化目标函数H_k的梯度：

其中，为优化目标函数H_k的梯度，θ_k为第k个关节的关节角度；

所述求解冗余机械臂的逆运动学加权项为：

所述冗余机械臂的逆运动学如下式所示：

其中，α、β均为阈值参数，α、β的计算公式如下：

由上述技术方案可知，本发明的有益效果为：第一，本发明利用雅克比矩阵变化和优化的梯度投影方法实现了冗余度机械臂的奇异规避，避免了求解冗余度雅克比矩阵的伪逆和行列式问题，有较高的实时性能，满足工业计算实时需求；第二，本发明利用逼近阻尼倒数方法求解冗余机械臂逆运动学，有效的提高了机械臂在奇异点附近的轨迹精度，能够满足冗余度机械臂的工业用途需求。

附图说明

图1为本发明的方法流程图。

具体实施方式

如图1所示，一种冗余机械臂奇异点规避方法，该方法包括下列顺序的步骤：

(1)通过对冗余机械臂雅克比矩阵降维，构建雅克比方阵J_q；

(2)推导雅克比方阵J_q的奇异因子k_i，并利用逼近阻尼倒数方法，求解雅克比方阵J_q的逆矩阵J_q ^-1；

(3)通过雅克比方阵J_q的逆矩阵J_q ^-1求解冗余机械臂的逆运动学通解和特解/>

(4)利用优化的梯度投影算法，求解冗余机械臂的逆运动学加权项得到冗余机械臂的逆运动学/>实现冗余机械臂的奇异点规避。

所述步骤(1)具体是指：首先，计算冗余机械臂第五个关节的坐标系下的雅克比矩阵⁵J∈R(6×7),并将冗余机械臂第五个关节的坐标系下的雅克比矩阵的所有行和列重新排列组合，使得变换后的矩阵J′中的右上角矩阵为零矩阵，如下式所示：

其中，j_l∈R(6×1)为雅克比矩阵⁵J的第l列；J₁₁,J₂₁,J₂₂∈R(3×3)为雅克比⁵J的子矩阵；雅克比方阵J_q是指将雅克比矩阵⁵J中的除j_l之外的所有列组合在一起构成的6×6的方形矩阵。

在步骤(2)中，所述推导雅克比方阵J_q的奇异因子k_i是指将雅克比子矩阵J₁₁,J₂₂的行列式作为机械臂的奇异因子ki；所述利用逼近阻尼倒数方法，求解雅克比方阵J_q的逆矩阵J_q ^-1为：首先根据矩阵变换方法，将雅克比方阵J_q的逆矩阵表示为奇异因子k_i的倒数的函数；然后利用逼近阻尼倒数代替奇异因子k_i的倒数，求解出雅克比方阵J_q的逆矩阵J_q ^-1。

在步骤(3)中，所述求解冗余机械臂的逆运动学通解和特解/>的公式为：

其中，为冗余机械臂末端速度。

在步骤(4)中，所述优化的梯度投影算法为：

首先，定义优化目标函数H_k如下：

然后，求优化目标函数H_k的梯度：

其中，为优化目标函数H_k的梯度，θ_k为第k个关节的关节角度；

所述求解冗余机械臂的逆运动学加权项为：

所述冗余机械臂的逆运动学如下式所示：

其中，α、β均为阈值参数，α、β的计算公式如下：

综上所述，本发明利用雅克比矩阵变换和优化的梯度投影方法实现了冗余机械臂的奇异点规避，无需计算冗余机械臂雅克比矩阵伪逆和行列式，大大降低了算法复杂度，有较好的实时性能；本发明利用逼近阻尼方法求解冗余机械臂逆运动学，有效的提高了机械臂在奇异点附近的轨迹精度。

Claims (3)

1.一种冗余机械臂奇异点规避方法，其特征在于：该方法包括下列顺序的步骤：

(1)通过对冗余机械臂雅克比矩阵降维，构建雅克比方阵J_q；

(2)推导雅克比方阵J_q的奇异因子k_i，并利用逼近阻尼倒数方法，求解雅克比方阵J_q的逆矩阵J_q ^-1；

(3)通过雅克比方阵J_q的逆矩阵J_q ^-1求解冗余机械臂的逆运动学通解和特解/>

(4)利用优化的梯度投影算法，求解冗余机械臂的逆运动学加权项得到冗余机械臂的逆运动学/>实现冗余机械臂的奇异点规避；

所述步骤(1)具体是指：首先，计算冗余机械臂第五个关节的坐标系下的雅克比矩阵⁵J∈R(6×7),并将冗余机械臂第五个关节的坐标系下的雅克比矩阵的所有行和列重新排列组合，使得变换后的矩阵J′中的右上角矩阵为零矩阵，如下式所示：

其中，j_l∈R(6×1)为雅克比矩阵⁵J的第l列；J₁₁,J₂₁,J₂₂∈R(3×3)为雅克比⁵J的子矩阵；雅克比方阵J_q是指将雅克比矩阵⁵J中的除j_l之外的所有列组合在一起构成的6×6的方形矩阵；

在步骤(4)中，所述优化的梯度投影算法为：

首先，定义优化目标函数H_k如下：

然后，求优化目标函数H_k的梯度：

其中，为优化目标函数H_k的梯度，θ_k为第k个关节的关节角度；

所述求解冗余机械臂的逆运动学加权项为：

所述冗余机械臂的逆运动学如下式所示：

其中，α、β均为阈值参数，α、β的计算公式如下：

2.根据权利要求1所述的冗余机械臂奇异点规避方法，其特征在于：在步骤(2)中，所述推导雅克比方阵J_q的奇异因子k_i是指将雅克比子矩阵J₁₁,J₂₂的行列式作为机械臂的奇异因子k_i；所述利用逼近阻尼倒数方法，求解雅克比方阵J_q的逆矩阵J_q ^-1为：首先根据矩阵变换方法，将雅克比方阵J_q的逆矩阵表示为奇异因子k_i的倒数的函数；然后利用逼近阻尼倒数代替奇异因子k_i的倒数，求解出雅克比方阵J_q的逆矩阵J_q ^-1。

3.根据权利要求1所述的冗余机械臂奇异点规避方法，其特征在于：在步骤(3)中，所述求解冗余机械臂的逆运动学通解和特解/>的公式为：

其中，为冗余机械臂末端速度。