机械与材料工程

机器人手指抓取临界力问题的动力系统求解方法

  • 黄国林 , a ,
  • 孙菊贺 , a ,
  • 王莉 a ,
  • 曹宁珊 b ,
  • 马宁 c
展开
  • a. 沈阳航空航天大学,理学院,沈阳 110136
  • b. 沈阳航空航天大学,自动化学院,沈阳 110136
  • c. 沈阳航空航天大学,机电工程学院,沈阳 110136

黄国林(2000—),男,江西抚州人,硕士研究生,主要研究方向为优化方法在力学及工程上的应用,E-mail:

孙菊贺(1980—),女,辽宁辽阳人,教授,博士,主要研究方向为优化理论与算法,E-mail:

收稿日期: 2025-01-24

  修回日期: 2025-04-10

  录用日期: 2025-04-12

  网络出版日期: 2026-06-15

基金资助

国家自然科学基金(52475482)

The dynamical system method for solving the critical force problem of robotic finger grasping

  • Guolin HUANG , a ,
  • Juhe SUN , a ,
  • Li WANG a ,
  • Ningshan CAO b ,
  • Ning MA c
Expand
  • a. College of Science, Shenyang Aerospace University,Shenyang 110136,China
  • b. College of Automation, Shenyang Aerospace University,Shenyang 110136,China
  • c. College of Mechanical and Electrical Engineering, Shenyang Aerospace University,Shenyang 110136,China

Received date: 2025-01-24

  Revised date: 2025-04-10

  Accepted date: 2025-04-12

  Online published: 2026-06-15

摘要

为确保抓取稳定、防止物体滑脱并避免结构损伤,建立了3种机器人手指常见的抓取模型,精准求解机器人手指抓取过程中的临界力。在机器人手设计和被抓物体理想物理假设的情况下,通过力学中的受力分析,根据静力学平衡方程得出机器人手指抓取临界力问题的约束条件,进一步给出抓取临界力优化模型。首先,根据优化模型写出karush-kuhn-tucker(KKT)条件,然后利用NR函数将其转化为光滑方程组,进一步引入价值函数,将KKT条件转化为无约束优化问题。构建动力方程系统,并分析动力方程系统的稳定性,利用动力方程系统解和优化问题解之间的关系,从而求解机器人手指抓取临界力问题。最后,通过数值实验验证动力方程系统方法的有效性。

本文引用格式

黄国林 , 孙菊贺 , 王莉 , 曹宁珊 , 马宁 . 机器人手指抓取临界力问题的动力系统求解方法[J]. 沈阳航空航天大学学报, 2026 , 43(2) : 43 -48 . DOI: 10.3969/j.issn.2095-1248.2026.02.006

Abstract

To ensure grasping stability, prevent object slippage, and avoid structural damage, three common grasping models were established for a three-fingered robotic hand, and the critical force during the robotic finger grasping process was accurately solved. In the case of the design of the robot hand and the ideal physical assumption of the object to be grasped, through the force analysis in mechanics, the constraints of the critical force of the robot finger grasping problem were obtained according to the static equilibrium equation, and the optimization model of the critical force of the robot finger grasping was further given. Firstly, the KKT condition was written according to the optimization model, and then the NR function was used to transform it into a smooth equation system, and the value function was further introduced to transform the KKT condition into an unconstrained optimization problem. The dynamic equation system was constructed, and the stability of the dynamic equation system was analyzed, and the relationship between the solution of the dynamic equation system and the solution of the optimization problem was used to solve the critical force problem of robot finger grasping. Finally, a numerical experiment was conducted to verify the effectiveness of the dynamical equation system method.

在物体和机器人手指接触点处施加能够保证稳定抓取物体而不滑动的最小的力,被称为临界力。为了实现高度灵巧的机器人操作,抓取力优化的结果至关重要。Natarajan等1提出了一个线性关系方程来描述物体质量和所需最小抓取力之间的关系。Liang等2研究了机器人手小指的对立运动对机器手抓取性能的影响。Xia等3对多指机械人手指抓取力优化展开研究。Nakamura等4提出使用拉格朗日乘子法求解最优力,Kumar等5提出了接触力优化的次优算法,而Buss等6将接触力优化问题转化为半定规划问题,再使用投影梯度流算法进行求解。针对接触力优化问题和变分不等式问题,很多学者也进行了深入的研究。Lobo等7讨论了二阶锥规划(SOCP)在解决变分不等式问题中的应用,Sun等8在早期提出了两种神经网络模型来处理SOCCVI问题的KKT条件,总结了神经网络在解决SOCCVI问题方面的潜力,Sun等9列举了一个关于求解机器人抓取力问题,将优化问题转化为SOCCVI,最后使用提出的神经网络求解出最优力。
本文对机器人施加在物体上的抓取力进行分析,使之不会掉落物体或破坏物体,进一步提高机器人工作的效率。在Lobo等7和Sun等9的启发下,本文研究的创新点是将抓取力优化问题转化为无约束优化问题,并利用动力方程系统方法求解该问题,从而解决了机器人手指抓取力优化问题。

1 机器人手的设计

根据摩擦情况,手指和物体之间的接触又可以为分无摩擦点接触和有摩擦点接触10。本文要解决机器人手指临界力问题,就必须知道机器人手指是如何设计的。目前机器人手爪的类型有很多,包括多指灵巧手爪、机械手爪等。在日常生活中,抓取物体一般有以下两种方式,如图1所示。
本文研究的机器人手指设计类似于图1b,基于三指机器人手的抓取临界力优化问题展开研究。设物体的质量为 m,重力加速度g=9.8 m/s2。机器人手指抓取物体以速度 v沿着半径 r做圆形路径移动,机器人抓取物体随时间运动轨迹图如图2所示,向心力 f c = m v 2 / r,角度 θ ( t ) = v t / r
图2 机器人抓取物体随时间运动轨迹图

2 机器人手指抓取临界力问题的模型建立

抓取临界力问题是寻找一组最佳接触力,使得物体的合力为0,并且物体保持在合理的位置运动。由文献[1112]可知,力闭合能够抵消外力和力矩,并限制物体在所需方向上的运动。本节将考虑一类三指机器人手指在三维空间抓取物体且和被抓物体之间存在3个接触点的问题。取机器人手指抓取物体的某一个瞬间进行受力分析,以接触点为原点,建立空间直角坐标系。以被抓物体为研究对象,将机器人手指传给物体的接触力 y i ( i = 1,2 , 3 )沿着坐标轴分解为两部分:一是垂直于表面的分量 y i 3,二是切向于表面的分量 y i 1 y i 2。而机器人每个手指向物体施加的抓取力 y i必须保证物体能够稳定抓取,稳定抓取主要是为了确保物体和机器人手不产生相对滑动,防止物体掉落,抓取力需要满足的条件是切向作用力摩擦条件,即
y i 1 2 + y i 2 2 μ i y i 3
式中: μ i为接触处的摩擦系数。
首先假设物体形状规则且密度均匀分布,所以坐标系的原点和物体的质心重合。该物体的受力为空间力系,为了保持物体平衡,每个手指向物体施加抓取力 y i = [ y i 1 , y i 2 , y i 3 ]必须满足物体静力学平衡方程,其平衡方程公式为
i = 1 3 F i + f e x t i = 0 i = 4 6 F i d i + f e x t i = 0
式(2)中两个方程分别表示力的平衡方程和力矩的平衡方程,周洪等13推导出物体在抓取状态下的力平衡方程可以用矩阵形式代替。可以采用矩阵的形式将上面的方程组简化,其矩阵形式可以表示为
A y + f e x t = 0
式中: A R 6 × 3 m是抓取变换矩阵; f e x t = ( 0 , f c s i n θ ( t ) , - M g + f c c o s θ ( t ) , 0,0 , 0 ) T是随时间变化的外力, f c是物体做圆周运动的向心力; y = [ y 1 , y 2 , , y m ] T R 3 m y i R 3 ( i = 1,2 , , m )是抓取力矢量。
为了防止抓取力挤压物体及物体滑动,必须找到最优的抓取力,即找到一个临界力满足所有条件。本文考虑一个抓取力的二次目标函数,因此保持物体抓取临界力模型可以表示为如式(4)所示优化问题。
m i n   f ( y ) = 1 2 y T Q y + q T y   s . t .   A y + f e x t = 0       y i 1 2 + y i 2 2 μ i y i 3 , ( i = 1,2 , , m )
式中: Q为一个正定矩阵。

3 动力方程系统的构造

根据物体临界力问题模型,本节得出式(4)的KKT条件。
L ( y , α , λ ) Q T y + q T + A α + i = 1 3 y i 1 2 + y i 2 2 - μ i y i 3 λ i = 0 A y + f e x t = 0 0 λ i ( y i 1 2 + y i 2 2 - μ i y i 3 ) 0
式中: L ( y , α , λ ) = Q T y + q T + A α +
i = 1 3 y i 1 2 + y i 2 2 - μ i y i 3 T λ i式(4)的拉格朗日函数。接下来引入光滑化NR互补函数
ϕ N R ε ( u , v ) = u - 1 2 ( u - v + ( u - v ) 2 + e ε 2 )
式中: e为单位向量,则式(5)可以转化为光滑组方程,即
S ( ε , y , α , λ ) = ε L ( y , α , λ ) - h ( y ) ϕ N R ε ( - g ( y ) , λ ) = 0
式中: h ( y ) = A y + f e x t g ( y i ) = y i 1 2 + y i 2 2 - μ i y i 3 0 , ( i = 1,2 , , m )
z = ( ε , y , α , λ ),并引入价值函数 Φ ( z ) = 1 2 S T ( z ) S ( z ) = 1 2 S ( z ) 2,则式(5)可以写成式(8)的无约束优化问题。
m i n Φ ( z ) = m i n 1 2 S ( z ) 2
则有 Φ ( z ) = S ( z ) T S ( z ),建立的动力方程系统如式(9)所式14,求解无约束优化问题 m i n Φ ( z ) = m i n 1 2 S ( z ) 2
z ¨ ( t ) + γ ( t ) z ˙ ( t ) + β ( t ) Φ ( z ( t ) ) = 0
式中: γ ( t ) = θ t为正黏性阻尼系数, β ( t )为时间尺度系数,且 γ , β t [ t 0 , + )上是非负连续函数。由文献[15]可知,若 a r g m i n Φ非空,式(9)存在唯一的全局解。

4 动力系统的稳定性分析

Φ ( z ) = 0的情况下,对式(9)进行直接积分,可以得到 p ( t ) = e t 0 t γ ( u ) d u。假设条件 H 0 : t 0 + d u p ( u ) < + 满足,定义函数 Γ   :   [ t 0 , + )
Γ ( t ) = p ( t ) t + d u p ( u )
显然 Γ   :   [ t 0 , + )的定义不依赖于初始时间的选择,对其求导得
Γ ˙ ( t ) = γ   ( t ) Γ ( t ) - 1
定义全局能量函数
W ( t ) = 1 2 z ˙ ( t ) 2 + β ( t ) { Φ [ z ( t ) ] - m i n Φ }
和锚函数
h ( t ) = 1 2 z ( t ) - z * 2
式中: z * a r g m i n Φ。根据上述定义,定义函数 ζ ( t )式(14)所示, ζ ( t )在动力系统的收敛性分析中起着重要作用16
ζ ( t ) = Γ ( t ) 2 W ( t ) + h ( t ) + Γ ( t ) h ˙ ( t )
式中: h ˙t)为ht)导数。
定理1 假设 Φ : R n R是一个凸函数,且解集 a r g m i n Φ非空。正黏性阻尼系数 γ ( t )和时间尺度系数 β ( t ) t [ t 0 , + )都是连续的函数,其增长条件 H γ , β式(15)所示。
H γ , β : Γ ( t ) β ˙ ( t ) β ( t ) [ 3 - 2 γ ( t ) Γ ( t ) ]
式(9)的轨迹 z ( t ) Γ ( t ) z ˙ ( t ) [ t 0 , + )上是有界的,并且当 t + 时的收敛速率为
Φ [ z ( t ) ] - m i n Φ = O [ 1 β ( t ) Γ ( t ) 2 ]
证明:对能量函数 ζ ( t )进行求导,得
ζ ˙ ( t ) = ( 2 Γ ( t ) Γ ˙ ( t ) β ( t ) + Γ ( t ) 2 β ˙ ( t ) ) ( Φ ( z ( t ) ) - m i n Φ ) - Γ ( t ) β ( t ) Φ ( z ( t ) ) T , z ( t ) - z *
根据柯西不等式和函数 Φ的凸性,可以推断出不等式
ζ ˙ ( t ) [ 2 Γ ( t ) Γ ˙ ( t ) β ( t ) + Γ ( t ) 2 β ˙ ( t ) ] [ Φ ( z ( t ) ) - m i n Φ ] 0
因此,能量函数 ζ ( t )是有界的,并结合 ζ ( t )的定义,可以得到
z ( t ) - z * 2 + 2 Γ ( t ) z ( t ) - z * , z ˙ ( t ) C
其中, C = 2 ζ ( t 0 ) h ˙ ( t ) = z ( t ) - z * , z ˙ ( t ),动力方程系统解轨迹是有界的,则 Γ ( t ) z ˙ ( t )有界。
已知函数 ζ ( t )是有界的,并且 ζ ( t ) ζ ( t 0 ) ( t 0 , t )上是成立的。对于任意的 t t 0,有
Φ ( z ( t ) ) - m i n Φ ζ ( t 0 ) β ( t ) Γ ( t ) 2
则定理1结论成立。

5 数值实验

取被抓物体质量 m = 0.1   k g,机器人手指抓取物以速度 v = 0.4   π m / s沿着半径 r = 0.2   m圆形路径移动。
θ ( t ) = 0.4 π,令 ( x i , x i + 1 , x i + 2 ) = ( μ y i + 2 , y i , y i + 1 ),考虑如式(21)形式的优化问题。
m i n    f ( x ) = 1 2 x T d i a g ( 1 μ 2 , 1,1 , 1 μ 2 , 1,1 , 1 μ 2 , 1,1 ) x s . t .     A ¯ x +   f e x t = 0          x i + 2 2 + x i + 1 2 - x i 2 0         ( i = 1,4 , 7 )
式中: x T = x 1 , x 2 , x 3 , x 4 , x 5 , x 6 , x 7 , x 8 , x 9 μ为摩擦系数; A ¯为抓取变换矩阵;式(21)的相关参数具体数值为
μ = 0.60   f e x t = ( 0,0.08 π 2 s i n ( 0.4 π ) , - 0.98 + 0.08 π 2 c o s ( 0.4 π ) , 0,0 , 0 ) T A ¯ = 0 0 1 - 5 3 0 0 0 1 0 - 5 3 0 0 0 0 - 1 5 3 0 0 0 - 1 0 0 - 1 0 0 0 - 1 0 - 1 0 0 - 0.5 0 0 0 1 0 0 0 0 1 0 0 0 0 0 0 - 1 5 6 0 - 1 0 1 0
式(9)的参数选取 θ = 25 β ( t ) = 1。解的轨迹xt)随时间t的变化图如图3所示,可见轨迹最后总是趋于一组稳定值。
图3 解的轨迹 x ( t )随时间 t变化图

6 结论

本文给出机器人的手指抓取临界力问题的优化模型,并得出对应的优化问题模型的KKT条件。通过光滑化NR函数,将优化问题的KKT条件转化为光滑方程组,借助价值函数,进而将机器人手指抓取临界力问题模型转化为无约束优化问题。通过建立动力方程系统求解无约束优化问题,并严格地证明了该动力系统的稳定性。最后给出一个数值实验验证了动力方程系统的有效性。
[1]
Natarajan E Solihin M I Chong J H.Grasp stabi-lity analysis of an isotropic direct driven three-finger soft robot hand[J].International Journal on Advanced Science,Engineering and Information Technology20177(5):1627-1631.

[2]
Liang R H Zhang Q F Yang W L,et al.Opposition movement of the little finger enhances the grasping function of robotic hands[J].IEEE Robo-tics and Automation Letters20249(4):3743-3750.

[3]
Xia Y S Wang J Fok L M.Grasping-force optimization for multifingered robotic hands using a recurrent neural network[J].IEEE Transactions on Robotics and Automation200420(3):549-554.

[4]
Nakamura Y Nagai K Yoshikawa T.Dynamics and stability in coordination of multiple robotic mechanisms[J].The International Journal of Robotics Research19898(2):44-61.

[5]
Kumar V Waldron K J.Suboptimal algorithms for force distribution in multifingered grippers[J].IEEE Transactions on Robotics and Automation19895(4):491-498.

[6]
Buss M Hashimoto H Moore J B.Dextrous hand grasping force optimization[J].IEEE Transactions on Robotics and Automation199612(3):406-418.

[7]
Lobo M S Vandenberghe L Boyd S,et al.Applications of second-order cone programming[J].Li-near Algebra and Its Applications1998284(1/2/3):193-228.

[8]
Sun J H Chen J S Ko C H.Neural networks for solving second-order cone constrained variational inequality problem[J].Computational Optimizat-ion and Applications201251(2):623-648.

[9]
Sun J H Fu W C Alcantara J H,et al.A neural network based on the metric projector for solving SOCCVI problem[J].IEEE Transactions on Neural Networks and Learning Systems202132(7):2886-2900.

[10]
刘庆运,钱瑞明,颜景平.机器人多指手抓取运动学研究综述[J].机械科学与技术200625(8):967-971.

[11]
Nguyen V D.Constructing force-closure grasps[J].The International Journal of Robotics Research19887(3):3-16.

[12]
Watanabe T Yoshikawa T.Optimization of gras-ping by using a required external force set[C]//2003 IEEE International Conference on Robotics and Automation.Taipei:IEEE,2003:1127-1132.

[13]
周洪,郑文纬.一种新的计算三指机器人柔性手抓取力的方法[J].浙江工学院学报199018(3):36-45.

[14]
谢红俭,孙菊贺,王莉,等.微分方程方法求解约束优化问题[J].应用数学进展2024(5):2125-2132.

[15]
Attouch H Chbani Z Riahi H.Fast convex optimization via time scaling of damped inertial gradient dynamics[J/OL].Mathematics,(2019-05-24)[2021- 03-03].

[16]
贾丹娜,王莉,孙菊贺,等.带扰动项的二阶微分方程方法求解变分不等式问题[J].沈阳航空航天大学学报202340(5):90-96.

文章导航

/