多自由度机械臂关节运动控制研究

李美强; 马庆禄; 闫浩; 余腾伟

doi:10.16579/j.issn.1001.9669.2025.02.018

您当前的位置：

首页 >

文章列表页 >

多自由度机械臂关节运动控制研究

·设计·计算· | 更新时间：2025-02-28

- 多自由度机械臂关节运动控制研究
- Research on joint motion control for multi-degree-of-freedom manipulator
- 机械强度 2025年47卷第2期页码：147-158
- 作者机构：
  
  1.重庆交通大学交通运输学院，重庆 400074
  2.重庆交通大学机电与车辆工程学院，重庆 400074
- 作者简介：
  
  李美强，男，1996年生，四川达州人，硕士研究生；主要研究方向为机械臂控制与运动规划；E-mail：1904621608@qq.com。
  马庆禄（通信作者），男，1980年生，陕西渭南人，博士，教授；主要研究方向为智能交通、隧道安全；E-mail：mql360@qq.com。
- 基金信息：
  
  交通工程应用机器人重庆市工程实验室2022年度开放课题(CELTEAR-KFKT-202301);国家自然科学基金项目(52072054);重庆市技术创新与应用发展专项重点项目(cstc2021jscx-cylh0026)
- DOI：10.16579/j.issn.1001.9669.2025.02.018
  中图分类号： TP241.1
- 收稿日期：2023-07-02，
  
  修回日期：2023-09-14，
  
  纸质出版日期：2025-02-15
- 稿件说明：
移动端阅览
李美强，马庆禄，闫浩，等. 多自由度机械臂关节运动控制研究［J］. 机械强度，2025，47（2）：147-158.

LI Meiqiang，MA Qinglu，YAN Hao，et al. Research on joint motion control for multi-degree-of-freedom manipulators［J］. Journal of Mechanical Strength，2025，47（2）：147-158.
李美强，马庆禄，闫浩，等. 多自由度机械臂关节运动控制研究［J］. 机械强度，2025，47（2）：147-158. DOI： 10.16579/j.issn.1001.9669.2025.02.018.

LI Meiqiang，MA Qinglu，YAN Hao，et al. Research on joint motion control for multi-degree-of-freedom manipulators［J］. Journal of Mechanical Strength，2025，47（2）：147-158. DOI： 10.16579/j.issn.1001.9669.2025.02.018.

摘要

机械臂结构具有高度非线性和强耦合等特点，高精度运动控制一直是国内外学者关注的热点问题。以AR4机械臂为研究对象，对机械臂控制影响较大的正、逆运动学进行系统的分析，确定机械臂相应结构参数，利用D-H法求解机械臂正、逆运动学数值计算模型。针对机械臂在空间运动中关节卡顿产生的抖动现象，采用三次样条插值算法进行优化。在笛卡儿空间规划中采用直线插补法减少末端执行器运动距离，通过Matlab仿真得出具体规划点，满足设计要求。最后，利用SolidWorks建立机械臂的三维模型并生成统一机器人描述格式（Unified Robot Description Format，URDF）模型，使用MoveIt进行实际机械臂在关节空间和笛卡儿空间的轨迹规划，通过RViz展示运动过程。试验结果表明，加入三次样条插值算法后，机械臂关节电动机能够保持稳定的运转，相对于无三次样条插值算法，关节轨迹曲率分别降低了15.4%、35.6%、21.3%、26.8%、18.98%和45.7%，有效解决了关节运动过程中的抖振问题，实现了机械臂平稳运动。

Abstract

The structure of the manipulator has the characteristics of high nonlinearity and strong coupling

and high-precision motion control is a hot topic of concern for scholars.The AR4 manipulator was used as the research object to systematically analyze the forward and inverse kinematics that greatly impact the control of the manipulator

determining the manipulator’s corresponding structural parameters.And the D-H method was used to solve the numerical calculation model of the manipulator forward and inverse kinematics.The cubic spline interpolation algorithm was used to optimize the manipulator's jitter phenomenon in the joint space.In Cartesian space planning

the linear interpolation method was used to reduce the end effector’s motion distance.The specific planning points were obtained by Matlab simulation，meeting the design requirements.Finally

the SolidWorks was used to establish a three-dimensional model of the manipulator and generate an unified robot description formatc (URDF)model.The actual trajectory of the manipulator in joint and Cartesian space was planned according to MoveIt

and through RViz

the movement process was displayed.The results show that after adding the cubic spline interpolation algorithm

the joint motors of the manipulator can maintain stable operation

and the joint trajectory curvature is respectively reduced by 15.4%

35.6%

21.3%

26.8%

18.98% and 45.7%

which effectively solves the jitter vibration problem during joint movement and achieves smooth motion of the manipulator.

关键词

Keywords

references

陈超，陈贺贺，武姝婷，等 . 工业机器人机械臂的结构优化［J］. 机床与液压， 2021 ， 49 （ 3 ）： 25 - 29 .

CHEN Chao ， CHEN Hehe WU Shuting ， et al . Structural optimization of industrial robot manipulator ［J］ . Machine Tool & Hydraulics ， 2021 ， 49 （ 3 ）： 25 - 29 . （In Chinese）

万珍平，罗钊，陆龙生，等 . 关节角参数化结合接近矢量可行方向的五自由度机械臂逆运动学求解［J］. 华南理工大学学报（自然科学版）， 2023 ， 51 （ 1 ）： 16 - 21 .

WAN Zhenping ， LUO Zhao ， LU Longsheng ， et al . Inverse kinematics solution of 5-DOF manipulator via joint angle parameterization and feasible direction of approach vector ［J］. Journal of South China University of Technology（Natural Science Edition）， 2023 ， 51 （ 1 ）： 16 - 21 . （In Chinese）

顾大可，唐重建 . 三连杆机械臂控制系统设计的参数化方法［J］. 控制工程， 2019 ， 26 （ 8 ）： 1566 - 1571 .

GU Dake ， TANG Chongjian . Three-link robot control system design based on parametric solutions ［J］. Control Engineering of China ， 2019 ， 26 （ 8 ）： 1566 - 1571 . （In Chinese）

夏细明 . 多自由度机器人机械手腕关节柔顺控制方法［J］. 科学技术与工程， 2018 ， 18 （ 20 ）： 275 - 280 .

XIA Ximin . Compliance control method of robot wrist joint in multi degree of freedom robot ［J］. Science Technology and Engineering ， 2018 ， 18 （ 20 ）： 275 - 280 . （In Chinese）

李元春，宋扬，赵博 . 环境约束可重构机械臂模块化力/位置控制［J］. 上海交通大学学报， 2017 ， 51 （ 6 ）： 709 - 714 .

LI Yuanchun ， SONG Yang ， ZHAO Bo . Modular position/force control for environmental constrained reconfigurable manipulator ［J］. Journal of Shanghai Jiaotong University ， 2017 ， 51 （ 6 ）： 709 - 714 . （In Chinese）

徐学义 . 基于ANN-VRFT的机械臂位置控制［J］. 工业控制计算机， 2016 ， 29 （ 9 ）： 59 - 61 .

XU Xueyi . Position control of manipulator based on ANN-VRFT ［J］. Industrial Control Computer ， 2016 ， 29 （ 9 ）： 59 - 61 . （In Chinese）

赵韩，赵福民，黄康，等 . 基于Udwadia-Kalaba理论的机械臂位置控制［J］. 合肥工业大学学报（自然科学版）， 2018 ， 41 （ 4 ）： 433 - 438 .

ZHAO Han ， ZHAO Fumin ， HUANG Kang ， et al . Position control of mechanical manipulator based on Udwadia-Kalaba theory ［J］. Jour-nal of Hefei University of Technology（Natural Science）， 2018 ， 41 （ 4 ）： 433 - 438 . （In Chinese）

刘杰，历飞雨 . 基于弹性关节的二自由度机械臂建模与控制研究［J］. 机电工程， 2022 ， 39 （ 6 ）： 846 - 853 .

LIU Jie ， LI Feiyu . Modeling and control of 2-DOF robot arm based on elastic joint ［J］. Journal of Mechanical & Electrical Engineering ， 2022 ， 39 （ 6 ）： 846 - 853 . （In Chinese）

宁海成 . 基于非线性微分方程的机械臂运动位置控制方法［J］. 机械与电子， 2022 ， 40 （ 11 ）： 46 - 50 .

NING Haicheng . Position control method of manipulator arm movement based on nonlinear differential equation ［J］. Machinery & Ele-ctronics ， 2022 ， 40 （ 11 ）： 46 - 50 . （In Chinese）

梁艳芳，杨永明，胡云飞，等 . 基于改进滑膜控制器的机械臂力/位混合控制研究［J］. 科技创新与应用， 2022 ， 12 （ 23 ）： 91 - 98 .

LIANG Yanfang ， YANG Yongming ， HU Yunfei ， et al . Research on hybrid control of mechanical arm force/position based on improved synovial controller ［J］. Technology Innovation and Application ， 2022 ， 12 （ 23 ）： 91 - 98 . （In Chinese）

戚毅凡，贾英宏，赵宝山，等 . 基于改进神经网络的空间机械臂阻抗控制方法［J］. 中国空间科学技术， 2022 ， 42 （ 2 ）： 82 - 90 .

QI Yifang ， JIA Yinghong ， ZHAO Baoshan ， et al . Impedance control of space manipulator based on improved neural network ［J］. Chin-ese Space Science and Technology ， 2022 ， 42 （ 2 ）： 82 - 90 . （In Chinese）

黄自鑫，赖旭芝，王亚午，等 . 基于轨迹规划的平面三连杆欠驱动机械臂位置控制［J］. 控制与决策， 2020 ， 35 （ 2 ）： 382 - 388 .

HUANG Zixin ， LAI Xuzhi ， WNG Yawu ， et al . Position control of planar three-link underactuated manipulator based on trajectory planning ［J］. Control and Decision ， 2020 ， 35 （ 2 ）： 382 - 388 . （In Chinese）

郑先杰，丁萌，武海雷，等 . 线驱连续型机械臂无模型自适应控制［J］. 华中科技大学学报（自然科学版）， 2023 ， 51 （ 2 ）： 116 - 121 .

ZHENG Xianjie ， DING Meng ， WU Hailei ， et al . Model-free adaptive control of cable-driven continuum manipulator ［J］. Journal of Huazhong University of Science and Technology（Natural Science Edition）， 2023 ， 51 （ 2 ）： 116 - 121 . （In Chinese）

段纯，顾建华 . 基于逆动力学的机械臂鲁棒位置控制方法的设计［J］. 中国工程机械学报， 2020 ， 18 （ 3 ）： 242 - 247 .

DUAN Chun ， GU Jianhua . Design of robust position control method for manipulator based on inverse dynamics shift ［J］. Chinese Jour-nal of Construction Machinery ， 2020 ， 18 （ 3 ）： 242 - 247 . （In Chinese）

倪杭，王贺升，陈卫东 . 基于软体机器人冗余自由度的实时避障位置控制［J］. 机器人， 2017 ， 39 （ 3 ）： 265 - 271 .

NI Hang ， WANG Hesheng ， CHEN Weidong . Real-time obstacle avoidance and position control for a soft robot based on its redun-dant freedom ［J］. Robot ， 2017 ， 39 （ 3 ）： 265 - 271 . （In Chinese）

赵寅甫，冯正勇 . 基于深度强化学习的机械臂控制快速训练方法［J］. 计算机工程， 2022 ， 48 （ 8 ）： 113 - 120 .

ZHAO Yinfu ， FENG Zhengyong . Fast training method for mani-pulator control based on deep reinforcement learning ［J］. Computer Engineering ， 2022 ， 48 （ 8 ）： 113 - 120 . （In Chinese）

谭丹丹 . 基于自适应变阻抗的工业机器人双机械臂控制［J］. 现代制造工程， 2022 （ 8 ）： 39 - 45 .

TAN Dandan . Control for industrial robot twin-manipulator based on adaptive variable impedance ［J］. Modern Manufacturing Engin-eering ， 2022 （ 8 ）： 39 - 45 . （In Chinese）

李树荣，尹怀强 . 具有时滞的柔性关节多机械臂协同自适应位置/力控制［J］. 控制理论与应用， 2017 ， 34 （ 9 ）： 1208 - 1214 .

LI Shurong ， YIN Huaiqiang . Adaptive position/force control for coordinated multiple flexible-joint manipulators with time delay ［J］. Control Theory & Applications ， 2017 ， 34 （ 9 ）： 1208 - 1214 . （In Chinese）

FRANCESCHETTI A ， TOSELLO E ， CASTAMAN N ， et al . Robotic arm control and task training through deep reinforcement learning ［J］. Lecture Notes in Networks and Systems ， 2022 ， 412 ： 532 - 550 .

陈志勇，陈力 . 柔性关节空间双臂机器人奇异摄动增广鲁棒自适应PD复合控制［J］. 振动与冲击， 2015 ， 34 （ 16 ）： 79 - 84 .

CHEN Zhiyong ， CHEN Li . Singular perturbation augmented robust adaptive PD composite control for flexible-joint dual-arm space robot ［J］. Journal of Vibration and Shock ， 2015 ， 34 （ 16 ）： 79 - 84 . （In Chinese）

BIGLARBEGIAN M ， MELEK W W ， MENDEL J M . Design of novel interval type-2 fuzzy controllers for modular and reconfigurable robots： theory and experiments ［J］. IEEE Transactions on Industrial Electronics ， 2011 ， 58 （ 4 ）： 1371 - 1384 .

刘伟东，宁汝新，刘检华，等 . 基于偏差有向图和D-H方法的产品装配精度预测技术［J］. 机械工程学报， 2012 ， 48 （ 7 ）： 125 - 140 .

LIU Weidong ， NING Ruxin ， LIU Jianhua ， et al . Precision predicting based on directed deviation graph modeling and D-H methodology ［J］. Journal of Mechanical Engineering ， 2012 ， 48 （ 7 ）： 125 - 140 . （In Chinese）

李珺茹，齐立群，韩文波 . 六自由度机械臂运动学分析与轨迹优化［J］. 长春理工大学学报（自然科学版）， 2019 ， 42 （ 1 ）： 68 - 73 .

LIU Junru ， QI Liqun ， HAN Wenbo . Kinematics analysis and trajectory optimization of six degree of freedom manipulator ［J］. Journal of Changchun University of Science and Technology（Natural Science Edition）， 2019 ， 42 （ 1 ）： 68 - 73 . （In Chinese）

浏览量

下载量

CSCD

文章被引用时，请邮件提醒。

提交

工具集

关联资源

刚柔耦合串并联康复机械臂运动特性分析

改进的LMD及在齿轮故障诊断的应用