驱动副共面平行的<strong>3-P(2-SS)</strong>型并联机器人运动特性及动力学分析

doi:10.3785/j.issn.1006-754X.2025.05.177

工程设计学报

2025, Vol. 32

Issue (5): 646-654 DOI: 10.3785/j.issn.1006-754X.2025.05.177

机器人与机构设计

驱动副共面平行的3-P(2-SS)型并联机器人运动特性及动力学分析

李瑾(

)

山西工程技术学院机械工程系，山西阳泉 045000

Kinematic characteristics and dynamics analysis of 3-P(2-SS) robot with coplanar parallel driving pairs

Jin LI(

)

Department of Mechanical Engineering, Shanxi Institute of Technology, Yangquan 045000

全文: PDF(1979 KB) HTML

摘要：

由3个平行且共面的移动副驱动的3-P(2-SS)型并联机器人相对传统构型更适合在狭长区域作业。针对该机器人，构建了其运动学方程和雅可比矩阵，并分析了其运动学方程的多解性。利用其运动学方程和螺旋理论，证实了在正常工况下机器人动平台始终只有3个平移自由度，并简化了机器人的运动学方程和雅可比矩阵。利用雅可比矩阵条件数分析了机器人的灵巧性，当2侧的滑块位于动平台同侧时，机器人的灵巧性较好；机器人在奇异点和运动范围边界附近时灵巧性较差。基于拉格朗日方程构建了机器人动力学模型，利用最小角速度假设解决了连杆的局部自由度带来的动力学不确定问题，通过动坐标系变换解决了连杆惯性张量相对静坐标系的不恒定问题，得到了机器人动力学方程。通过动力学计算结果与运动仿真结果的对比，证实了动力学方程的正确性，最小角速度假设导致的驱动力计算结果误差在可控范围内。研究结果表明，驱动副共面平行的3-P(2-SS)并联机器人具有良好的操作性，提出的动力学建模方法为该型机器人力控制系统的构建提供了理论基础。

关键词： 3-P(2-SS); 并联机器人; 自由度; 灵巧性; 动力学

Abstract:

The 3-P(2-SS) parallel robot driven by three parallel and coplanar prismatic pairs is more suitable for operation in narrow and long areas compared to the traditional configurations. For this robot, its kinematic equations and Jacobian matrix were established, and the multi-solution nature of the kinematic equations was analyzed. By using the kinematic equations and the screw theory, it was confirmed that under normal working conditions, the robot's moving platform always had only three translational degrees of freedom, thereby simplifying the robot's kinematic equations and Jacobian matrix. The dexterity of the robot was analyzed using the condition number of the Jacobian matrix. The robot exhibited better dexterity when the sliders on both sides were located on the same side of the moving platform; the robot's dexterity deteriorated when it was near the singular points and the boundaries of the motion range. A robot dynamic model was established based on the Lagrange equation. The issue of dynamic uncertainty caused by the local degrees of freedom of the link was resolved using the minimum angular velocity assumption, the problem of the non-constant inertia tensor of the ink relative to the static coordinate system was addressed through transformation of the moving coordinate system, and the robot dynamic equation was obtained. By comparing the results of the dynamics calculation and motion simulation, the correctness of the dynamic equation was confirmed, with the error in the driving force calculation results caused by the minimum angular velocity assumption being within an acceptable range. The research results indicate that the 3-P(2-SS) parallel robot with coplanar parallel driving pairs has excellent operability, and the proposed dynamics modeling method provides a theoretical foundation for the construction of control systems for this type of robot.

Key words: 3-P(2-SS) parallel robot degree of freedom dexterity dynamics

收稿日期: 2025-03-20 出版日期: 2025-10-31

CLC:

TP 242

基金资助: 山西省阳泉市基础研究项目(2022JH054)

作者简介: 李　瑾（1989—），男，讲师，硕士，从事机器人技术研究，E-mail：342040973@163.com, https://orcid.org/0009- 0007-7221-7435

	服务
	把本文推荐给朋友
	加入引用管理器
	E-mail Alert
	RSS
	作者相关文章
	李瑾

引用本文:

李瑾. 驱动副共面平行的3-P(2-SS)型并联机器人运动特性及动力学分析[J]. 工程设计学报, 2025, 32(5): 646-654.

Jin LI. Kinematic characteristics and dynamics analysis of 3-P(2-SS) robot with coplanar parallel driving pairs[J]. Chinese Journal of Engineering Design, 2025, 32(5): 646-654.

链接本文:

https://www.zjujournals.com/gcsjxb/CN/10.3785/j.issn.1006-754X.2025.05.177 或 https://www.zjujournals.com/gcsjxb/CN/Y2025/V32/I5/646

图1 驱动副共面平行3-P(2-SS)机器人运动机构简图

参数	含义
$L 1$	连杆 $A 1 A 2$ 、 $A 3 A 4$ 的长度
$L 2$	连杆 $B 1 B 2$ 、 $B 3 B 4$ 的长度
$L 3$	连杆 $C 1 C 2$ 、 $C 3 C 4$ 的长度
$M$	$B 5 O D$ 、 $A 5 O D$ 的长度
$N$	$C 5 O D$ 的长度
$E$	相邻移动副滑轨的间距
$α$	$A 1 A 3$ 、 $B 1 B 3$ 与X₀轴之间的夹角 $A 2 A 4$ 、 $B 2 B 4$ 与X_D轴之间的夹角
$T$	$A 0 A 1$ 、 $A 0 A 3$ 、 $A 5 A 2$ 、 $A 5 A 4$ 、 $B 0 B 1$ 、 $B 0 B 3$ 、 $B 5 B 2$ 、 $B 5 B 4$ 、 $C 0 C 1$ 、 $C 0 C 3$ 、 $C 5 C 2$ 、 $C 5 C 4$ 的长度

表1 驱动副共面平行3-P(2-SS)机器人结构参数

图2 动平台不同安装姿态

图3 取不同运动学逆解时雅可比矩阵条件数

参数	含义
$g$	重力加速度
$m D$	动平台质量
$m S 1$	滑块A质量
$m S 2$	滑块B质量
$m S 3$	滑块C质量
$m l 1$	连杆 $A 1 A 2$ 、 $A 3 A 4$ 的质量
$m l 2$	连杆 $B 1 B 2$ 、 $B 3 B 4$ 的质量
$m l 3$	连杆 $C 1 C 2$ 、 $C 3 C 4$ 的质量
$v l 1$	连杆 $A 1 A 2$ 、 $A 3 A 4$ 沿 $O 0$ 各轴向的平动速度
$v l 2$	连杆 $B 1 B 2$ 、 $B 3 B 4$ 沿 $O 0$ 各轴向的平动速度
$v l 3$	连杆 $C 1 C 2$ 、 $C 3 C 4$ 沿 $O 0$ 各轴向的平动速度
$A l 1$	连杆 $A 1 A 2$ 、 $A 3 A 4$ 相对 $O A$ 的惯性张量
$B l 2$	连杆 $B 1 B 2$ 、 $B 3 B 4$ 相对 $O B$ 的惯性张量
$C l 3$	连杆 $C 1 C 2$ 、 $C 3 C 4$ 相对 $O C$ 的惯性张量
$A l 1$	连杆 $A 1 A 2$ 、 $A 3 A 4$ 相对 $O A$ 的转动角速度
$B l 2$	连杆 $B 1 B 2$ 、 $B 3 B 4$ 相对 $O B$ 的转动角速度
$C l 3$	连杆 $C 1 C 2$ 、 $C 3 C 4$ 相对 $O C$ 的转动角速度

表2 驱动副共面平行3-P(2-SS)机器人动力学参数

图4 连杆A1A2的动坐标系{OA}

图5 驱动副共面平行3-P(2-SS)机器人移动副驱动力动力学计算结果与仿真结果的对比

[1]	田波，娄军强，沈家旭，等. 可用于微创手术的毫米级微小并联机器人的设计、制造及实现［J］. 机械工程学报， 2024， 60（17）： 147-155. TIAN B， LOU J Q， SHEN J X， et al. Design， fabrication and realization of a parallel microrobot at the millimeter scale for minimally invasive surgery［J］. Journal of Mechanical Engineering， 2024， 60（17）： 147-155.
[2]	李清，刘荣帅，丰玉玺，等. 新型并联机器人的构型设计与运动学分析［J］. 包装工程， 2020， 41（9）： 167-173. LI Q， LIU R S， FENG Y X， et al. Configuration design and kinematics analysis of a new parallel robot［J］. Packaging Engineering， 2020， 41（9）： 167-173.
[3]	吕志忠，张成维，钟功祥，等. 一种四足磁吸附爬壁机器人运动学分析及仿真［J］. 工程科学与技术， 2020， 52（2）： 121-129. LYU Z Z， ZHANG C W， ZHONG G X， et al. Kinematics analysis and simulation of a quadruped magnetic adsorption wall-climbing robot［J］. Advanced Engineering Sciences， 2020， 52（2）： 121-129.
[4]	梁栋，梁正宇，畅博彦，等. 多臂机提综臂辅助旋铆并联机器人优化设计［J］. 工程设计学报， 2022， 29（1）： 28-40. LIANG D， LIANG Z Y， CHANG B Y， et al. Optimal design of assisting-riveting parallel robot for lifting arm of dobby loom［J］. Chinese Journal of Engineering Design， 2022， 29（1）： 28-40.
[5]	刘荣帅，李清，杜昱东，等. 3-CUR并联分拣机器人的运动学分析与仿真［J］. 包装工程， 2019， 40（21）： 179-186. LIU R S， LI Q， DU Y D， et al. Kinematics analysis and simulation of 3-CUR parallel sorting robot［J］. Packaging Engineering， 2019， 40（21）： 179-186.
[6]	王学军，张帆. 攀爬机器人动力学建模与分析［J］. 机械科学与技术， 2023， 42（1）： 38-45. WANG X J， ZHANG F. Dynamic modeling and analysis of climbing robot［J］. Mechanical Science and Technology for Aerospace Engineering， 2023， 42（1）： 38-45.
[7]	王耀军，金翔. 基于运动/力传递性能的索并联机器人尺度综合研究［J］. 机电工程， 2024， 41（11）： 2029-2040， 2118. WANG Y J， JIN X. Dimensional synthesis of cable-driven parallel robots based on the motion/force transmission performance［J］. Journal of Mechanical & Electrical Engineering， 2024， 41（11）： 2029-2040， 2118.
[8]	潘英，方跃法，汪丛哲. 五自由度3D打印并联机器人设计及分析［J］. 中国机械工程， 2016， 27（17）： 2273-2279. PAN Y， FANG Y F， WANG C Z. Design and analysis of five DOF 3D printing parallel robot［J］. China Mechanical Engineering， 2016， 27（17）： 2273-2279.
[9]	ZHANG L， LI R Q， NING F P， et al. Performance analysis and optimization design of a dual-mode reconfigurable ankle joint parallel rehabilitation mechanism［J］. Applied Sciences， 2024， 14（5）： 1757.
[10]	HAN M， CHE J J， LIU J Y， et al. Performance evaluation and dimensional optimization design of planar 6R redundant actuation parallel mechanism［J］. Robotica， 2024， 42（5）： 1649-1675.
[11]	HUSSAIN S， JAMWAL P K， VAN VLIET P. Design synthesis and optimization of a 4-SPS intrinsically compliant parallel wrist rehabilitation robotic orthosis［J］. Journal of Computational Design and Engineering， 2021， 8（6）： 1562-1575.
[12]	ZOFFOLI F， IDA’ E， CARRICATO M. Design and control optimization for hybrid-controlled overconstrained cable-driven parallel robots［J］. Mechanism and Machine Theory， 2025， 209： 105998.
[13]	SHAH M F， JAMWAL P K， GOECKE R， et al. A parallel mechanism-based virtual biomechanical shoulder robot model： Mechanism design optimization and motion planning［J］. Mechanics Based Design of Structures and Machines， 2025， 53（4）： 2744-2764.
[14]	梁栋，李世友，畅博彦，等. 冗余驱动精密定位并联机器人动力学优化［J］. 机械设计与研究， 2022， 38（5）： 79-87. LIANG D， LI S Y， CHANG B Y， et al. Dynamic optimization for precision positioning parallel manipulator with redundant actuation［J］. Machine Design & Research， 2022， 38（5）： 79-87.
[15]	王敏，孙景健，丁基恒，等. 基于D-H参数与拉格朗日联立方程的仿生水蛇机器人运动学分析及动力学建模［J］. 机械工程学报， 2024， 60（15）： 134-148. WANG M， SUN J J， DING J H， et al. Kinematics analysis and dynamics modeling of bionic water snake robot based on D-H parameters and Lagrange equations［J］. Journal of Mechanical Engineering， 2024， 60（15）： 134-148.
[16]	刘凉，汪博深，冯建峰，等. 含柔性动平台并联机器人动力学建模方法研究［J］. 农业机械学报， 2023， 54（12）： 417-430. LIU L， WANG B S， FENG J F， et al. Dynamic modeling method of parallel robot with flexible moving platform［J］. Transactions of the Chinese Society for Agricultural Machinery， 2023， 54（12）： 417-430.
[17]	翟国栋，刘龙宇，蔡晨光，等. 直线电机驱动六自由度并联机构动力学特性研究［J］. 农业机械学报， 2022， 53（11）： 450-458. ZHAI G D， LIU L Y， CAI C G， et al. Dynamic characteristics of 6-DOF parallel mechanism driven by linear motor［J］. Transactions of the Chinese Society for Agricultural Machinery， 2022， 53（11）： 450-458.
[18]	王福荣，辛焦丽. 一种求解一般Stewart台体型机构位置正解的算法［J］. 机械传动， 2016， 40（7）： 113-116. WANG F R， XIN J L. An algorithm for the forward position kinematics of general Stewart platform mechanism［J］. Journal of Mechanical Transmission， 2016， 40（7）： 113-116.
[19]	程世利，吴洪涛，王超群，等. 一般6-SPS并联机构运动学正解的解析化方法［J］. 中国机械工程， 2010， 21（11）： 1261-1264. CHENG S L， WU H T， WANG C Q， et al. Analytical method for forward kinematics analysis of general 6-SPS parallel mechanisms［J］. China Mechanical Engineering， 2010， 21（11）： 1261-1264.
[20]	黄昔光，廖启征，魏世民，等. 一般6-6型平台并联机构位置正解代数消元法［J］. 机械工程学报， 2009， 45（1）： 56-61. doi：10.3901/jme.2009.01.056 HUANG X G， LIAO Q Z， WEI S M， et al. Forward kinematics analysis of the general 6-6 platform parallel mechanism based on algebraic elimination［J］. Chinese Journal of Mechanical Engineering， 2009， 45（1）： 56-61. doi: 10.3901/jme.2009.01.056

[1]	魏孝杰,梁文峰,朱慧轩,郭凯,高飞扬,尹震宇,李松. 基于Stewart并联机器人的皮肤生物3D打印方法研究[J]. 工程设计学报, 2025, 32(5): 590-600.
[2]	刘玉航,张春燕,田正雨,刘正阳. 一种可变径多模式移动并联机器人的设计与分析[J]. 工程设计学报, 2025, 32(5): 634-645.
[3]	李翔,陶友瑞,王嘉,张扬,杨铖浩. 工业机器人线缆动态特性建模与布局优化[J]. 工程设计学报, 2025, 32(3): 383-392.
[4]	虞启辉,耿延歧,张立从. 基于动网格技术的双进/排气活塞式膨胀机动力性能研究[J]. 工程设计学报, 2025, 32(1): 132-140.
[5]	田立勇,敖华,于宁,唐瑞. 更换托辊机器人履带式底盘的仿真与优化[J]. 工程设计学报, 2024, 31(5): 603-613.
[6]	许哲,代威,曹宇,李永国,张舜. 欠驱动型ROV改进设计与纵倾优化[J]. 工程设计学报, 2024, 31(4): 483-490.
[7]	朱慧轩,崔广泽,李炳南,郭凯,王蔚,李松. 面向皮肤大面积损伤修复的原位打印系统工作空间分析[J]. 工程设计学报, 2024, 31(4): 529-537.
[8]	孙宝印,郝永平,张誉瀚,李子洋. 基于数字孪生的热电池保温棉自动缠绕系统研究[J]. 工程设计学报, 2024, 31(4): 538-546.
[9]	芮宏斌,王天赐,厍龙林,段凯文,李耒,郭旋,彭家璇. 受海龟爬行与山羊行走启发的四足仿生移动机器人多步态规划及动力学分析[J]. 工程设计学报, 2024, 31(3): 309-318.
[10]	马文滨,段志文,李想,张行. 基于振动响应分析的海底管道悬空内检测研究[J]. 工程设计学报, 2024, 31(3): 348-356.
[11]	曹望城,韩佳轩,姚廷强. 基于参数化多体动力学模型的内齿式回转支承动态优化设计[J]. 工程设计学报, 2024, 31(2): 168-177.
[12]	杨开科,罗俊鹏,马文静,耿远超,王德恩,袁强. 高带宽压电片变形镜的动力学仿真与优化方法研究[J]. 工程设计学报, 2024, 31(1): 130-136.
[13]	谢苗,石俊杰,张鸿宇,朱昀. 多激励下新型纵轴式掘进机的纵向振动特性预测[J]. 工程设计学报, 2023, 30(6): 728-737.
[14]	赵迪,陈果,陈小利,王熊锦. 轮式搜救机器人地形自适应机构设计及越障性能分析[J]. 工程设计学报, 2023, 30(5): 579-589.
[15]	陈洪月,蔡明航,杨辛未,戴忠桓. 更换电铲钢丝绳专用机械臂架的结构及动力学分析[J]. 工程设计学报, 2023, 30(5): 590-600.

Viewed

Full text

Abstract

Cited

Shared

Discussed