| Citation: | XU Yaru, LI Kehong, LIU Jia, et al. Constraint violation suppression for dynamics modeling of lower limb rehabilitation robot[J]. Journal of Beijing University of Aeronautics and Astronautics, 2022, 48(4): 609-619. doi: 10.13700/j.bh.1001-5965.2020.0628(in Chinese)
|
The U-K theory provides a new concept for obtaining the explicit dynamic equation of constraint multibody system. However, one consequence of the numerical approximation and truncation error is the constraint violation of the dynamic equation at the position and velocity level. Baumgarte's constraint violation stability methods (BSM) provide a stable dynamic equation by constraint modification. Nevertheless, the selection of Baumgarte parameters usually involve a trial-and-error process, which may result in the failure of simulation results. Consequently, the Baumgarte parameters selection problem is studied by using the classical fourth-order Runge-Kutta method, and the explicit dynamic equation of robot system based on the modified U-K theory by BSM is established. Furthermore, the lower limb rehabilitation robot is taken as the research object for simulation analysis. The results show that the constraint violation can be effectively suppressed. The joint angle errors are controlled within the range of -5×10-3(°)-5×10-3(°), the joint angular velocity errors are controlled within the range of -2×10-4 rad/s-2×10-4 rad/s, and the operation trajectory of the robot end-effector can be well close to the predetermined target of the system.
| [1] |
UDWADIA F E, KALABA R E. Analytical dynamics: A new approach[M]. Cambridge: Cambridge University Press, 2007.
|
| [2] |
LIU J, LIU R. Dynamic modeling of dual-arm cooperating manipulators based on Udwadia-Kalaba equation[J]. Advances in Mechanical Engineering, 2016, 8(7): 1-10.
|
| [3] |
HUANG K, SHAO K, ZHEN S C, et al. A novel approach for modeling and tracking control of a passive-wheel snake robot[J]. Advances in Mechanical Engineering, 2017, 9(3): 1-15.
|
| [4] |
LYU G Z, LIU R. Determination of stability correction parameters for dynamic equations of constrained multibody systems[J]. Mathematical Problems in Engineering, 2018, 2018: 1-10.
|
| [5] |
SUN H, ZHAO H, HUANG K, et al. A new approach for vehicle lateral velocity and yaw rate control with uncertainty[J]. Asian Journal of Control, 2018, 20(1): 216-227. doi: 10.1002/asjc.1531
|
| [6] |
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): 1-14.
|
| [7] |
PAPPALARDO C M, GUIDA D. On the dynamics and control of underactuated nonholonomic mechanical systems and applications to mobile robots[J]. Archive of Applied Mechanics, 2019, 89(4): 669-698. doi: 10.1007/s00419-018-1491-6
|
| [8] |
BLAJER W. Elimination of constraint violation and accuracy aspects in numerical simulation of multibody systems[J]. Multibody System Dynamics, 2002, 7(3): 265-284. doi: 10.1023/A:1015285428885
|
| [9] |
BRAUN D J, GOLDFARB M. Eliminating constraint drift in the numerical simulation of constrained dynamical systems[J]. Computer Methods in Applied Mechanics and Engineering, 2009, 198(37-40): 3151-3160. doi: 10.1016/j.cma.2009.05.013
|
| [10] |
BAUMGARTE J. Stabilization of constraints and integrals of motion in dynamical systems[J]. Computer Methods in Applied Mechanics and Engineering, 1972, 1(1): 1-16. doi: 10.1016/0045-7825(72)90018-7
|
| [11] |
LIN S T, CHEN M W. A PID type constraint stabilization method for numerical integration of multibody systems[J]. Journal of Computational and Nonlinear Dynamics, 2011, 6(4): 044501. doi: 10.1115/1.4002688
|
| [12] |
ZHANG X C, ZHANG X M, CHEN Z. Dynamic analysis of a 3-RRR parallel mechanism with multiple clearance joints[J]. Mechanism and Machine Theory, 2014, 78(78): 105-115.
|
| [13] |
MARQUES F, SOUTO A P, FLORES P. On the constraints violation in forward dynamics of multibody systems[J]. Multibody System Dynamics, 2016, 39: 385-419.
|
| [14] |
LIANG D, SONG Y M, SUN T. Nonlinear dynamic modeling and performance analysis of a redundantly actuated parallel manipulator with multiple actuation modes based on FMD theory[J]. Nonlinear Dynamics, 2017, 89(1): 391-428. doi: 10.1007/s11071-017-3461-x
|
| [15] |
GUO X, ZHANG D G, LI L, et al. Application of the two-loop procedure in multibody dynamics with contact and constraint[J]. Journal of Sound and Vibration, 2018, 427: 15-27. doi: 10.1016/j.jsv.2018.04.020
|
| [16] |
FLORES P, MACHADO M, SEABRA E, et al. A parametric study on the Baumgarte stabilization method for forward dynamics of constrained multibody systems[J]. Journal of Computational and Nonlinear Dynamics, 2011, 6(1): 1-9.
|
| [17] |
黎健玲. 数值分析与实验[M]. 北京: 科学出版社, 2012: 194-196.
LI J L. Numerical analysis and experiments[M]. Beijing: Science Press, 2012: 194-196(in Chinese).
|
| [18] |
LIN S T, HUANG J N. Stabilization of Baumgarte's method using the Runge-Kutta approach[J]. Journal of Mechanical Design, 2002, 124(4): 633-641. doi: 10.1115/1.1519277
|
| [19] |
OGATA K. Discrete-time control systems[M]. Englewood Cliffs: Prentice-Hall, 1994.
|
| [20] |
SHENOY P, MILLER K J, CRAWFORD B, et al. Online electromyographic control of a robotic prosthesis[J]. IEEE Transactions on Biomedical Engineering, 2008, 55(3): 1128-1135. doi: 10.1109/TBME.2007.909536
|
| [1] | ZHU Yuanjun, LI Yan, ZHANG Xuejun, ZHANG Weidong. Risk-Constrained Safe Path Planning for Unmanned Aerial Vehicles in Urban Airspace[J]. Journal of Beijing University of Aeronautics and Astronautics. doi: 10.13700/j.bh.1001-5965.2024.0843 |
| [2] | LI Huan, CUI Pengcheng, JIA Hongyin, GONG Xiaoquan, WU Xiaojun. Numerical Simulation of TSTO Interstage Separation Considering Constraint Force[J]. Journal of Beijing University of Aeronautics and Astronautics. doi: 10.13700/j.bh.1001-5965.2024.0839 |
| [3] | CUI Zhen, ZHAO Zhigang, SU Cheng, MENG Jiadong, ZHAO Xiangtang, CHAI Wei. Dynamics and Dynamic Stability Analysis of Rope Traction Upper Limb Rehabilitation Robot[J]. Journal of Beijing University of Aeronautics and Astronautics. doi: 10.13700/j.bh.1001-5965.2024.0827 |
| [4] | LIU S Y，YANG H L，ZHANG Z G，et al. Vibration control of flexible spacecraft with output constraints and external disturbances[J]. Journal of Beijing University of Aeronautics and Astronautics，2024，50（5）：1560-1567 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2022.0622. |
| [5] | ZHANG Y L，MA Z Z，SHI L，et al. Multi-agent coverage control based on communication connectivity maintenance constraints[J]. Journal of Beijing University of Aeronautics and Astronautics，2024，50（2）：519-528 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2022.0340. |
| [6] | JIANG W H，CHEN Z L，CHENG Y B，et al. Image captioning model based on divergence-based and spatial consistency constraints[J]. Journal of Beijing University of Aeronautics and Astronautics，2024，50（2）：456-465 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2022.0400. |
| [7] | ZHAO Ru-jian, YANG Wei, WU Zhen-yu, CENG Hong-cheng, CHEN Jie, MA Lei. Ship track prediction method based on LSTM and nautical chart constraints[J]. Journal of Beijing University of Aeronautics and Astronautics. doi: 10.13700/j.bh.1001-5965.2023.0516 |
| [8] | LIU Chunjuan, XIN Yuqiang, WU Xiaosuo, YAN Haowen. Semantic Segmentation Model for Remote Sensing Images Based on Nested U-Net Guided by Dual Attention[J]. Journal of Beijing University of Aeronautics and Astronautics. doi: 10.13700/j.bh.1001-5965.2024.0122 |
| [9] | REN Si-yuan, WANG Song, CHEN Gong, DENG Chen, PAN Zheng-xiao. Research on task planning of multiple UAVs with simultaneous arrival constraints[J]. Journal of Beijing University of Aeronautics and Astronautics. doi: 10.13700/j.bh.1001-5965.2023.0783 |
| [10] | YAN S Q，LIU W D，YANG P，et al. Multi group sparrow search algorithm based on K-means clustering[J]. Journal of Beijing University of Aeronautics and Astronautics，2024，50（2）：508-518 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2022.0328. |
| [11] | MA Y F，DAI S W，WANG R，et al. Nonlinear spatial K-means clustering algorithm for detection of zero-speed interval in inertial pedestrian navigation[J]. Journal of Beijing University of Aeronautics and Astronautics，2023，49（10）：2841-2850 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2021.0764. |
| [12] | GUO Q，WU T H，XU W，et al. Target tracking algorithm based on saliency awareness and consistency constraint[J]. Journal of Beijing University of Aeronautics and Astronautics，2023，49（9）：2244-2257 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2021.0688. |
| [13] | CHEN J J，YUAN H，XU Y，et al. GNSS instantaneous attitude determination method based on multi-variable constraints[J]. Journal of Beijing University of Aeronautics and Astronautics，2023，49（6）：1394-1401 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2021.0453. |
| [14] | LYU Y，CAO F. Robust beamforming based on linear constraint minimum variance algorithm[J]. Journal of Beijing University of Aeronautics and Astronautics，2023，49（3）：617-624 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2021.0280. |
| [15] | YANG Jun, ZHANG Jin-ying. U-shaped semantic segmentation network of high-resolution remote sensing images embedded with the self-attention mechanism[J]. Journal of Beijing University of Aeronautics and Astronautics. doi: 10.13700/j.bh.1001-5965.2023.0269 |
| [16] | BAO Y T，LIU W，LI R S，et al. Semantic segmentation of remote sensing images based on U-shaped network combined with spatial enhance attention[J]. Journal of Beijing University of Aeronautics and Astronautics，2023，49（7）：1828-1837 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2021.0544. |
| [17] | ZHOU Yu, XIA Hao, LIU Hong-yu, BAI Lei. DPC clustering algorithm based on K-reciprocal Neighbors and kernel density estimation[J]. Journal of Beijing University of Aeronautics and Astronautics. doi: 10.13700/j.bh.1001-5965.2023.0342 |
| [18] | ZHANG S，SONG T L，JIAO W，et al. Cooperative guidance method with interception time constraint[J]. Journal of Beijing University of Aeronautics and Astronautics，2023，49（8）：1956-1963 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2021.0569. |
| [19] | ZHU Y，XIAO S H，CHEN Z T. A registration algorithm with datum constraints and allowance constraints[J]. Journal of Beijing University of Aeronautics and Astronautics，2023，49（3）：580-587 （in Chinese）. doi: 10.13700/j.bh.1001-5965.2021.0314. |
| [20] | PAN Chang-zhong, HE Guang, LI Zhi-jing, ZHOU Lan, XIONG Pei-yin. Adaptive Filtered Control for Uncertain Electro-hydraulic Servo Systems with Time-varying Output Constraints[J]. Journal of Beijing University of Aeronautics and Astronautics. doi: 10.13700/j.bh.1001-5965.2022-0497 |
| 1. | 张新荣，康龙，张东升，张军. 基于约束跟随理论的消防无人机水枪喷嘴跟踪控制. 湖南大学学报(自然科学版). 2023(10): 112-123 .  |
Figures(6) / Tables(1)
Copyright © Journal of Beijing University of Aeronautics and Astronautics
Address: Editorial Department of Journal of Beijing University of Aeronautics and Astronautics, 37 Xueyuan Road, Haidian District, Beijing Post Code: 100191 Email: jbuaa@buaa.edu.cn
Supported by:
Beijing Renhe Information Technology Co., Ltd.
Han Zhuangzhi, Wang Tianmiao, Zhang Yuru, et al. Selection of calculation model for contact sensing of robot hand using force/torque measurement[J]. Journal of Beijing University of Aeronautics and Astronautics, 2004, 30(05): 400-404. (in Chinese)
DownLoad:
