2R耦合驱动关节动力学建模与参数辨识

doi:10.3901/JME.2022.23.051

机械工程学报 ›› 2022, Vol. 58 ›› Issue (23): 51-64.doi: 10.3901/JME.2022.23.051

扫码分享

2R耦合驱动关节动力学建模与参数辨识

卢浩^1,2,3, 郭士杰^1,2,3,4, 杨志强^1,2,3, 陈力^1,2,3, 邓飞⁴, 王洪波^1,2,3

1. 复旦大学工程与应用技术研究院上海 200433;
2. 复旦大学智能机器人教育部工程研究中心上海 200433;
3. 上海智能机器人工程技术研究中心上海 200433;
4. 河北工业大学机械工程学院天津 300130

收稿日期:2022-03-07 修回日期:2022-08-09 出版日期:2022-12-05 发布日期:2023-02-08
通讯作者: 郭士杰(通信作者),男,1963年出生,教授,博士研究生导师。主要研究方向为智能护理机器人、柔性步行助力机器人、无束缚生理信息检测、机器人智能传感技术。E-mail:guoshijie@fudan.edu.cn
作者简介:卢浩,男,1990年出生,博士研究生。主要研究方向为智能护理机器人、卒中康复机器人。E-mail:luh20@fudan.edu.cn
基金资助:
上海科技计划(21511101701)和国家重点研发计划(2021YFC0122704)资助项目。

Research on Dynamic Modeling and Parameter Identification of 2R Coupling Drive Joint

LU Hao^1,2,3, GUO Shijie^1,2,3,4, YANG Zhiqiang^1,2,3, CHEN Li^1,2,3, DENG Fei⁴, WANG Hongbo^1,2,3

1. Academy for Engineering & Technology, Fudan University, Shanghai 200433;
2. Institute of AI and Robotics, Fudan University, Shanghai 200433;
3. Shanghai Engineering Research Center of AI & Robotics, Shanghai 200433;
4. School of Mechanical Engineering, Hebei University of Technology, Tianjin 300130

Received:2022-03-07 Revised:2022-08-09 Online:2022-12-05 Published:2023-02-08

摘要/Abstract

摘要： 围绕护理机器人的人机安全接触和轻量大负载需求，提出了一种2R耦合驱动关节构型，并解决了耦合驱动动力学建模问题，为高性能运动控制器搭建提供基础。该关节设计紧凑、负载能力强，两个伺服电机经过三级减速后，通过差动结构实现两自由度耦合输出，且表面光滑适宜与人接触。通过运动学分析了耦合驱动的原理，利用拉格朗日法建立了耦合驱动动力学模型。为解决速度零点摩擦力不连续，造成基于模型的控制器运动性能变差的问题，引入了连续可微摩擦模型，利用连续可微特性采用灰色模型提高了辨识精度。研制了机器人关节样机，进行了关节解耦、摩擦数据采集、参数辨识及轨迹跟踪等试验，结果表明所设计的耦合驱动关节可以完成周转、俯仰两个转动自由度的单独及耦合运动，并且输出扭矩与重量的比值达到了143.6 N·m/kg，可以满足轻量大负载护理需求，同时基于所建立动力学模型的运动控制可以显著提高轨迹跟踪的准确性。

关键词: 护理机器人, 耦合驱动关节, 动力学建模, 连续摩擦模型

Abstract: A kind of 2R coupling drive joint configuration is proposed to meet the requirements of human-robot safe contact and light-weight-large-load of the nursing-care robot. The coupling drive dynamics modeling method is solved, which provides a basis for building a high-performance motion controller. After three-stage deceleration, the two servo motors of the joint realize the coupling output of two degrees of freedom through the differential structure. This design makes the joint suitable for contact with people by strong load capacity and smooth surface. The principle of coupling drive is analyzed through kinematics, and the dynamic model of coupling drive is established by the Lagrange method. The continuous differentiable friction model is introduced to solve the problem of discontinuous friction at speed zero to improve the motion performance of the motion controller. After the robot joint prototype is developed, joint decoupling, friction data acquisition, parameter identification, and trajectory tracking are conducted. The results showed that the designed coupling drive joint could complete the independent and coupling movement of turnover and pitch. The ratio of output torque to weight reaches 143.6 N·m/kg, which can meet the nursing needs of light-weight -heavy-load. At the same time, the motion control based on the established dynamic model can significantly improve the accuracy of trajectory tracking.

Key words: nursing-care robot, coupling drive joint, dynamics modeling, continuous friction model

中图分类号:

TP242

卢浩, 郭士杰, 杨志强, 陈力, 邓飞, 王洪波. 2R耦合驱动关节动力学建模与参数辨识[J]. 机械工程学报, 2022, 58(23): 51-64.

LU Hao, GUO Shijie, YANG Zhiqiang, CHEN Li, DENG Fei, WANG Hongbo. Research on Dynamic Modeling and Parameter Identification of 2R Coupling Drive Joint[J]. Journal of Mechanical Engineering, 2022, 58(23): 51-64.

参考文献

[1] 刘玉鑫,郭士杰,陈贵亮,等. 仿人背抱式移乘护理机器人背负运动轨迹规划与舒适性分析[J]. 机械工程学报,2020,56(15):147-156. LIU Yuxin,GUO Shijie,CHEN Guiliang,et al. Trajectory planning and comfortableness analysis of humanoid moving nursing robot[J]. Journal of Mechanical Engineering,2020,56(15):147-156.
[2] WANG T,JEONG H,WATANABE M,et al. Fault classification with discriminant analysis during sit-to-stand movement assisted by a nursing care robot[J]. Mechanical Systems and Signal Processing,2018,113(1):90-101.
[3] 左国玉,于双悦,龚道雄. 遥操作护理机器人系统的操作者姿态解算方法研究[J]. 自动化学报,2016,42(12):1839-1848. ZUO Guoyu,YU Shuangyue,GONG Daoxiong. Research on operator attitude calculation method of teleoperated nursing robot system[J]. Acta Automatica Sinica,2016,42(12):1839-1848.
[4] 毛晨涛,张翔,祖洪飞,等. 工业机器人重载下关节变形补偿[J]. 振动工程学报,2021,34(4):697-703. MAO Chentao,ZHANG Xiang,ZU Hongfei,et al. Joint deformation compensation for industrial robot under heavy load[J]. Journal of Vibration Engineering,2021,34(4):697-703.
[5] MUKAI T,HIRANO S,NAKASHIMA H,et al. Development of a nursing-care assistant robot RIBA that can lift a human in its arms[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems,18-22 Oct. 2010,Taipei,Taiwan,China:IEEE,2010:5996-6001.
[6] OLARUI M C,KRUT S,PIERROT F. Novel mechanical design of biped robot SHERPA using 2 DOF cable differential modular joints[C]//IEEE/RSJ International Conference on Intelligent Robots & Systems,10-15 Oct. 2009,St. Louis,MO,USA:IEEE,2009:4463-4468.
[7] HAGN U,NICKL M,JRG S,et al. The DLR MIRO:A versatile lightweight robot for surgical applications[J]. Industrial Robot,2008,35(08):324-336.
[8] CHUNG W,YONG Y,NING C,et al. Design of a rescue robot with a wearable suit augmenting high payloads rescue missions[C]//20172nd International Conference on Advanced Robotics and Mechatronics (ICARM). 27-31 Aug. 2017,Hefei and Tai'an,China:IEEE,2017:704-711.
[9] ONTAÑÓN-RUIZ J,DANIEL R W,MCAREE P R. On the use of differential drives for overcoming transmission nonlinearities[J]. Field Robotics,1998,15(11):641-660.
[10] 李志华,吴晨佳,江德,等. 基于量化状态系统的柔性关节机器人动力学求解方法[J]. 机械工程学报,2020,56(3):121-129. LI Zhihua,WU Chenjia,JIANG De,et al. Dynamic solution method of flexible joint robot based on quantitative state system[J]. Journal of mechanical engineering,2020,56(3):121-129.
[11] SU Y X,ZHENG C H,MUELLER P C,et al. A simple improved velocity estimation for low-speed regions based on position measurements only[J]. IEEE Transactions on Control Systems Technology,2006,14(5):937-942.
[12] MICHAEL R,MAKOTO I. Observer of nonlinear friction dynamics for motion control[J]. IEEE Transactions on Industrial Electronics,2015,62(9):5941-5949.
[13] TSAI M,CHANG S. Axial heat conduction model to predict maximum heat remove of miniature heat pipe based on grey model theory[J]. Chinese Journal of Mechanical Engineering,2005,18(4):477-481.
[14] 吴文祥,朱世强,靳兴来. 基于改进傅里叶级数的机器人动力学参数辨识[J]. 浙江大学学报(工学版),2013,47(2):231-237. WU Wenxiang,ZHU Shiqiang,JIN Xinglai. Robot dynamic parameter identification based on Improved Fourier series[J]. Journal of Zhejiang University (Engineering Edition),2013,47(2):231-237.
[15] RUAN Q,WU J,YAO Y. Design and analysis of a multi-legged robot with pitch adjustive units[J]. Chinese Journal of Mechanical Engineering,2021,34(3):239-255.
[16] 史延雷,张小俊,张明路. 主-被动复合变刚度柔性关节设计与分析[J]. 机械工程学报,2018,54(3):55-62. SHI Yanlei,ZHANG Xiaojun,ZHANG Minglu. Design and analysis of active passive composite variable stiffness flexible joint[J]. Journal of Mechanical Engineering,2018,54(3):55-62.
[17] SUN W,SU S,XIA J,et al. Adaptive fuzzy tracking control of flexible-joint robots with full-state constraints[J]. IEEE Transactions on Systems Man Cybernetics-Systems,2019,49(11):2201-2209.
[18] CHERUBINI A,PASSAMA R,CROSNIER A,et al. Collaborative manufacturing with physical human-robot interaction[J]. Robotics and Computer Integrated Manufacturing:An International Journal of Manufacturing and Product and Process Development,2016,40(1):1-13.
[19] OZGOLI S,TAGHIRAD H D. A survey on the control of flexible joint robots[J]. Asian Journal of Control,2006,8(4):332-344.
[20] LIU T,LIU H,LI Y,et al. Flexible FTIR spectral imaging enhancement for industrial robot infrared vision sensing[J]. IEEE Transactions on Industrial Informatics,2019,16(1):544-554.
[21] HIRUKAWA H. Walking biped humanoids that perform manual labour[J]. Philosophical Transactions of the Royal Society A:Mathematical,Physical and Engineering Sciences,2007,365(1850):65-77.
[22] ZHAO Y,XING H,GUO S,et al. A novel noncontact detection method of surgeon's operation for a master-slave endovascular surgery robot[J]. Medical & Biological Engineering & Computing,2020,58(4):871-885.
[23] THEIN T U,LWIN K T. Optimizing the microstructure and mechanical properties of austempered ductile iron for automobile differential gear[J]. Journal of Metals,Materials and Minerals,2008,18(2):199-205.
[24] AL-BENDER F,SWEVERS J. Characterization of friction force dynamics[J]. IEEE Control Systems Magazine,2008,28(6):64-81.
[25] FRIEDLAND B,PARK Y J. On adaptive friction compensation[J]. IEEE Transactions on Automatic Control,1992,37(10):1609-1612.
[26] MICHAEL R. Tracking control of motor drives using feedforward friction observer[J]. IEEE Transactions on Industrial Electronics,2014,61(7):3727-3735.
[27] 张铁,李秋奋,邹焱飚. 轻载机器人动力学参数辨识中的关节摩擦力辨识[J]. 润滑与密封,2020,45(7):1-7. ZHANG Tie,LI Qiufen,ZOU Yanbiao. Joint friction identification in dynamic parameter identification of light load robot[J]. Lubrication and Sealing,2020,45(7):1-7.
[28] BICAKCI S,AKDAS D,KARAOGLAN A D. Optimizing Karnopp friction model parameters of a pendulum using RSM[J]. European Journal of Control,2014,20(4):180-187.
[29] PEYRET N,ROSATELLO M,CHEVALLIER G,et al. A mindlin derived Dahl friction model[J]. Mechanism and Machine Theory,2017,117:48-55.
[30] JOHANASTROM K,CANUDAS D W. Revisiting the LuGre friction model[J]. IEEE Control Systems Magazine,2008,28(6):101-114.
[31] MAKKAR C,HU G,SAWYER W G,et al. Lyapunov-based tracking control in the presence of uncertain nonlinear parameterizable friction[J]. IEEE Transactions on Automatic Control,2007,52(10):1988-1994.
[32] MARQUES F,FLORES P,CLARO J C P,et al. Modeling and analysis of friction including rolling effects in multibody dynamics:A review[J]. Multibody System Dynamics,2019,45(2):223-244.
[33] NA J,CHEN Q,REN X,et al. Adaptive prescribed performance motion control of servo mechanisms with friction compensation[J]. IEEE Transactions on Industrial Electronics,2013,61(1):486-494.

2R耦合驱动关节动力学建模与参数辨识

Research on Dynamic Modeling and Parameter Identification of 2R Coupling Drive Joint

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	张俊, 吴成阳, 方汉良, 孙载超, 王凯龙, 汤腾飞. Z4型冗余驱动并联操作器的驱动特性研究[J]. 机械工程学报, 2024, 60(7): 66-78.
[2]	商德勇, 黄欣怡, 黄云山, 张天佑. 基于Kane方程的Delta并联机器人刚柔耦合动力学研究[J]. 机械工程学报, 2024, 60(7): 124-133.
[3]	王敏, 孙景健, 丁基恒, 孙翊, 彭艳, 蒲华燕, 罗均, 谢少荣. 基于D-H参数与拉格朗日联立方程的仿生水蛇机器人运动学分析及动力学建模[J]. 机械工程学报, 2024, 60(15): 134-148.
[4]	王明昊, 汪满新. 一种新型五自由度混联机器人动力学建模与性能评价[J]. 机械工程学报, 2023, 59(9): 63-75.
[5]	赵睿英, 余进, CHEN Y H, 冯艳丽, 曹学鹏. 机械系统动力学Rosenberg嵌入法的扩展与解耦：一阶约束与二阶约束的整合[J]. 机械工程学报, 2023, 59(9): 101-115.
[6]	朱子俊, 朱祥龙, 董志刚, 康仁科, 鲍岩. 磨削加工颤振稳定性研究综述[J]. 机械工程学报, 2023, 59(21): 15-33.
[7]	于曰伟, 赵雷雷, 谭迪, 周长城. 考虑牵引电机振动的列车-轨道系统垂向耦合动力学分析[J]. 机械工程学报, 2023, 59(16): 379-389.
[8]	马光同, 曾靖淞, 冯丕极, 闫兆盈, 张伟海. 超导电动磁悬浮列车次级悬挂混合阻尼半主动减振控制研究[J]. 机械工程学报, 2023, 59(10): 236-249.
[9]	徐向阳, 李龙, 任博, 朱才朝. 空间轴交角人字行星齿轮系统动态特性研究[J]. 机械工程学报, 2023, 59(1): 141-150.
[10]	徐灵敏, 叶伟, 李秦川. 并联机器人逆动力学建模的几何代数方法[J]. 机械工程学报, 2022, 58(7): 1-11.
[11]	雷声, 毛宽民, 田微, 孔德龙. 基于模型修正的螺栓结合部虚拟材料参数识别及应用[J]. 机械工程学报, 2022, 58(21): 274-284.
[12]	于曰伟, 赵雷雷, 周长城. 坐姿人体与车辆-轨道系统的垂向耦合作用机理[J]. 机械工程学报, 2022, 58(16): 290-300.
[13]	廖茂林, 宋文, 王晓勇, 辛岩莉, 郜志英. 直动型溢流阀的流固耦合建模与动态特性研究[J]. 机械工程学报, 2021, 57(23): 137-148.
[14]	庄未, 苏晓, 赵逸舟, 张瑞欣. 车把前倾角对无人驾驶自行车90°圆周运动的影响[J]. 机械工程学报, 2021, 57(2): 256-264.
[15]	熊万里, 孙文彪, 刘侃, 许铭华, 裴庭. 高速电主轴主动磁悬浮技术研究进展[J]. 机械工程学报, 2021, 57(13): 1-17.