基于奇异摄动的柔性关节机械臂约束跟随控制研究

欧劲松; 李蓉; 尹辉; 王华建

doi:10.21656/1000-0887.430024

基于奇异摄动的柔性关节机械臂约束跟随控制研究

doi: 10.21656/1000-0887.430024

湖南大学机械与运载工程学院，长沙 410082

基金项目:

国家自然科学基金项目（52105096）

详细信息

作者简介:
欧劲松（1998—），男，硕士(E-mail: 1658852414@qq.com);李蓉（1976—），女，副教授(通讯作者. E-mail: jyylirong@hnu.edu.cn);尹辉（1990—），男，助理教授，湖南大学“岳麓学者”(E-mail: yinhui233@126.com);王华建（1997—），男，硕士生(E-mail: 747114225@qq.com).

通讯作者:
李蓉（1976—），女，副教授(通讯作者. E-mail: jyylirong@hnu.edu.cn)

中图分类号: TH113
计量
- 文章访问数: 28
- HTML全文浏览量: 20
- PDF下载量: 0
- 被引次数: 0
出版历程
- 收稿日期: 2022-01-31
- 修回日期: 2023-04-29
- 网络出版日期: 2023-05-31

Research on Constraint Following Control of Flexible Joint Manipulators Based on Singular Perturbation

College of Mechanical and Vehicle Engineering， Hunan University， Changsha 410082, P.R.China

Funds:

The National Natural Science Foundation of China(52105096)

摘要

摘要: 针对二连杆柔性关节机械臂，提出了一种基于奇异摄动理论和UdwadiaKalaba(U-K)方法的控制方法.设计步骤主要分为两步：第一，基于奇异摄动法对系统进行降阶，把系统拆分为快、慢系统，不仅降低了求解系统的阶次，而且克服了系统柔性；第二，基于U-K方法设计了快、慢系统的状态反馈约束跟随控制律，能使快、慢系统约束跟随误差收敛到零，即使系统初始不满足约束条件，该方法不需要借助Lagrange乘子和伪广义速度等辅助变量，可以同时处理完整约束和非完整约束.将以上方法运用在二连杆柔性关节机械臂系统中，解决了二连杆柔性关节机械臂的柔性振荡和约束跟随的问题.使用MATLAB进行仿真，并且与传统PID控制进行了对比，验证了所提出的方法的有效性与优越性.
- 柔性机械臂 /
- 奇异摄动理论 /
- 约束跟随控制 /
- 轨迹跟踪
Abstract: For the control of 2-link flexible joint manipulators, a control method based on the singular perturbation theory and the Udwadia-Kalaba (U-K) method was proposed. The control design was implemented by 2 steps. First, the system order was reduced based on the singular perturbation method and the system was divided into fast and slow sub-systems, to simplify the solution process and overcome the system flexibility. Second, the state feedback constraint following control law for the fast and slow sub-systems was designed with the U-K method, to make the constraint following errors of the fast and slow sub-systems converge to zero, even if the system can't initially satisfy the constraints. The proposed method can deal with holonomic and nonholonomic servo constraints at the same time without the auxiliary variables of the Lagrange multiplier and the pseudo generalized velocity. The method was applied to 2-link flexible joint manipulator systems to solve the flexible oscillation and constraint following problems through simulations on MATLAB, and was compared with the traditional PID control, to verify the effectiveness and superiority.
- flexible manipulator /
- singular perturbation theory /
- constraint following control /
- trajectory tracking

HTML全文

参考文献(23)

[1]	YANG C G, JIANG Y M, HE W, et al. Adaptive parameter estimation and control design for robot manipulators with finite-time convergence[J].IEEE Transactions on Industrial Electronics,2018,65(10): 8112-8123.
[2]刘建昌, 苗宇. 基于神经网络补偿的机械臂轨迹控制策略的研究[J]. 控制与决策, 2005,20(7): 732-736.(LIU Jianchang, MIAO Yu. Research on trajectory control strategy of manipulator based on neural network compensation[J].Control and Decision,2005,20(7): 732-736.(in Chinese))
[3]陈强, 丁科新, 南余荣. 带有输出约束的柔性关节机械臂预设性能自适应控制[J]. 控制与决策, 2021,36(2): 387-394.(CHEN Qiang, DING Kexin, NAN Yurong. Prescribed performance adaptive control of flexible-joint manipulators with output constraints[J].Control and Decision,2021,36(2): 387-394.(in Chinese))
[4]YOO S J, PARK J B, CHOI Y H. Adaptive output feedback control of flexible-joint robots using neural networks: dynamic surface design approach[J].IEEE Transactions on Neural Networks,2008,19(10): 1712-1726.
[5]LING S, WANG H Q, LIU P X. Adaptive fuzzy dynamic surface control of flexible-joint robot systems with input saturation[J].CAA Journal of Automatica Sinica,2019,6(1): 97-107.
[6]LIU X, ZHAO F, GE S S, et al. End-effector force estimation for flexible-joint robots with global friction approximation using neural networks[J].IEEE Transactions on Industrial Informatics,2019,15(3): 1730-174.
[7]刘华平, 孙富春, 何克忠, 等. 奇异摄动控制系统: 理论与应用[J]. 控制理论与应用, 2003,20(1): 1-7.(LIU Huaping, SUN Fuchun, HE Kezhong, et al. Survey of singularly perturbed control systems: theory and applications[J].Control Theory & Applications,2003,20(1): 1-7.(in Chinese))
[8]SPONG M W. Modeling and control of elastic joint robots[J].Journal of Dynamic Systems Measurement and Control,1987,109(4): 310-318.
[9]洪昭斌, 陈力. 柔性空间机械臂基于奇异摄动法的鲁棒跟踪控制和柔性振动主动控制[J]. 工程力学, 2010,27(8): 191-198.(HONG Zhaobin, CHEN Li. Robust control and active vibration control of space flexible manipulator by singular perturbation approach[J].Engineering Mechanics,2010,27(8): 191-198.(in Chinese))
[10]刘华山, 金元林, 程新, 等. 力矩输入有界的柔性关节机器人轨迹跟踪控制[J]. 控制理论与应用, 2019,36(6): 983-992.( LIU Huashan, JIN Yuanlin, CHENG Xin, et al. Trajectory tracking control for flexible-joint robot manipulators with bounded torque inputs[J].Control Theory & Applications,2019,36(6): 983-992.(in Chinese))
[11]KALABA R E, UDWADIA F E. Equations of motion for nonholonomic, constrained dynamical systems via Gauss’s principle[J].Journal of Applied Mechanics,1993,60(3): 662-668.
[12]KALABA R, UDWADIA F. Analytical dynamics with constraint forces that do work in virtual displacements[J].Applied Mathematics and Computation,2001,121(2/3): 211-217.
[13]UDWADIA F E, KALABA R E, PHOHOMSIRI P. Mechanical systems with nonideal constraints: explicit equations without the use of generalized inverses[J].Journal of Applied Mechanics, 2004,71(5): 615-621.
[14]WANICHANON T, CHO H, UDWADIA F E. An approach to the dynamics and control of uncertain multi-body systems[J].Procedia IUTAM,2015,13: 43-52.
[15]KOGANTI P B, UDWADIA F E. Unified approach to modeling and control of rigid multibody systems[J].Journal of Guidance, Control, and Dynamics,2016,39(12): 2683-2698.
[16]CHEN Y H. Constraint-following servo control design for mechanical systems[J].Journal of Vibration and Control,2009,〖STHZ〗 15(3): 369-389.
[17]CHEN Y H, ZHANG X R. Adaptive robust approximate constraint-following control for mechanical systems[J].Journal of the Franklin Institute,2010,347(1): 69-86.
[18]李旻, 熊亮, 尹辉, 等. 含不等式约束的欠驱动系统约束跟随控制[J]. 控制理论与应用, 2020,37(9): 1971-1982.(LI Min, XIONG Liang, YIN Hui, et al. Constraint-following control for underactuated systems with inequality constraints[J].Control Theory & Applications,2020,37(9): 1971-1982.(in Chinese))
[19]YIN H, CHEN Y H, YU D. Controlling an underactuated two-wheeled mobile robot: a constraint-following approach[J].Journal of Dynamic Systems Measurement and Control,2019,141(7): 1002-1011.
[20]韩江, 汪鹏, 董方方, 等. 基于Udwadia-Kalab方法的并联机器人鲁棒伺服约束控制[J]. 应用数学和力学, 2021,42(3): 264-274.(HAN Jiang, WANG Peng, DONG Fangfang, et al. Robust servo constrained control of parallel robots based on the Udwadia-Kalaba method[J].Applied Mathematics and Mechanics,2021,42(3): 264-274.(in Chinese))
[21]韩江, 汪鹏, 董方方, 等. 基于Udwadia-Kalaba方法的平面冗余并联机器人建模与轨迹跟踪控制[J]. 应用数学和力学, 2020,41(11): 1183-1196.(HAN Jiang, WANG Peng, DONG Fangfang, et al. Modeling and control of planar redundant parallel robots based on the Udwadia-Kalaba method[J].Applied Mathematics and Mechanics,2020,41(11): 1183-1196.(in Chinese))
[22]ZHAO X M, CHEN Y H , ZHAO H, et al. Udwadia-Kalaba equation for constrained mechanical systems: formulation and applications[J].Chinese Journal of Mechanical Engineering,2018,31(6): 11-24.
[23]HAN J, CHEN Y H, ZHAO X M, et al. Optimal design for robust control of uncertain flexible joint manipulators: a fuzzy dynamical system approach[J].International Journal of Control,2018,91(4): 947-951.