A Closed-Loop Dynamic Controller for Active Vibration Isolation Working on A Parallel Wheel-Legged Robot

Fei Guo1,2, Shoukun Wang2, Daohe Liu2,3, Junzheng Wang2
1National Key Laboratory of Human Factors Engineering, China Astronaut Research and Training Center, Beijing, China
2School of Automation, Beijing Institute of Technology, Beijing, China
3China State Shipbuilding Corporation Systems Engineering Research Institute, Beijing, China

Tóm tắt

AbstractServing the Stewart mechanism as a wheel-legged structure, the most outstanding superiority of the proposed wheel-legged hybrid robot (WLHR) is the active vibration isolation function during rolling on rugged terrain. However, it is difficult to obtain its precise dynamic model, because of the nonlinearity and uncertainty of the heavy robot. This paper presents a dynamic control framework with a decentralized structure for single wheel-leg, position tracking based on model predictive control (MPC) and adaptive impedance module from inside to outside. Through the Newton-Euler dynamic model of the Stewart mechanism, the controller first creates a predictive model by combining Newton-Raphson iteration of forward kinematic and inverse kinematic calculation of Stewart. The actuating force naturally enables each strut to stretch and retract, thereby realizing six degrees-of-freedom (6-DOFs) position-tracking for Stewart wheel-leg. The adaptive impedance control in the outermost loop adjusts environmental impedance parameters by current position and force feedback of wheel-leg along Z-axis. This adjustment allows the robot to adequately control the desired support force tracking, isolating the robot body from vibration that is generated from unknown terrain. The availability of the proposed control methodology on a physical prototype is demonstrated by tracking a Bezier curve and active vibration isolation while the robot is rolling on decelerate strips. By comparing the proportional and integral (PI) and constant impedance controllers, better performance of the proposed algorithm was operated and evaluated through displacement and force sensors internally-installed in each cylinder, as well as an inertial measurement unit (IMU) mounted on the robot body. The proposed algorithm structure significantly enhances the control accuracy and vibration isolation capacity of parallel wheel-legged robot.

Từ khóa


Tài liệu tham khảo

B A Cabezas, C Mastalli, H Dai, et al. Simultaneous contact, gait and motion planning for robust multi-legged locomotion via mixed-integer convex optimization. IEEE Robotics and Automation Letters, 2018, 3(3): 2531–2538.

F Guo, S Wang, J Wang et al. Kinematics-searched framework for quadruped traversal in a parallel robot. Industrial Robot: The International Journal of Robotics Research and Application, 2019, 47: 267–279.

T Klamt, M Schwarz, Christian Lenz et al. Remote mobile manipulation with the centauro robot: Full-body telepresence and autonomous operator assistance. Journal of Field Robotics, 2020, 37(5): 889–919.

M Bjelonic, C D Bellicoso, Y V D Viragh et al. Keep rollin’ - whole-body motion control and planning for wheeled quadrupedal robots. IEEE Robotics and Automation Letters, 2018, 4(2): 2116–2123.

S H Hyon, Y Ida, J Ishikawa et al. Whole-body locomotion and posture control on a torque-controlled hydraulic rover. IEEE Robotics and Automation Letters, 2019, 4(4): 4587–4594.

M Kalakrishnan, J Buchli, P Pastor et al. Learning, planning, and control for quadruped locomotion over challenging terrain. The International Journal of Robotics Researchs, 2011, 30(2): 236–258.

H Navvabi, A H D Markazi. New afsmc method for nonlinear system with state-dependent uncertainty: Application to hexapod robot position control. Journal of Intelligent and Robotic System, 2019, 95: 71–75.

S N Nabavi, A Akbarzadeh, J Enferadi. Closed-form dynamic formulation of a general 6-p us robot. Journal of Intelligent and Robotic Systemsm, 2019, 96(3-4): 317–330.

Y Huang, D M Pool, O Stroosma et al. Long-stroke hydraulic robot motion control with incremental nonlinear dynamic inversion. IEEE/ASME Transactions on Mechatronics, 2019, 24(1): 304–314.

A M Khan, D Yun, M A Ali et al. Adaptive impedance control for upper limb assist exoskeleton. In: Proceedings of the IEEE/RSJ International Conference on Robotics and Automation. Seattle, 2015: 4359–4366.

F Farsam, D Mohammad. A new hybrid intelligent control algorithm for a seven-link biped walking robot. Journal of Vibration and Control, 2014: 20(9): 1378–1393.

A Omur, S Uluc. Reactive planning and control of planar spring-mass running on rough terrain. IEEE Transactions on Robotics, 2012, 28(3): 567–579.

J Buchli, M Kalakrishnan, M Mistry et al. Compliant quadruped locomotion over rough terrain. In: Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems. Louis, 2009: 814–820.

D J Hyun, S Seok, J Lee et al. High speed trot-running: Implementation of a hierarchical controller using proprioceptive impedance control on the mit cheetah. The International Journal of Robotics Research, 2015, 33(11): 1417–1445.

E S Ahn, R W Longman, J J Kim et al. Evaluation of five control algorithms for addressing cmg induced jitter on a spacecraft testbed. Journal of the Astronautical Sciences, 2013, 60(3-4): 434–467.

K Subramanian, J B Rawlings, C T Maravelias et al. Integration of control theory and scheduling methods for supply chain management. Computers and Chemical Engineering, 2013, 51: 4–20.

J A Castano, E M Hoffman, A Laurenzi et al. A whole body attitude stabilizer for hybrid wheeled-legged quadruped robots. In: Proceedings of the IEEE/RSJ International Conference on Robotics and Automation. Brisbane, 2018: 706–712.

X Huang, J Sun, H Hua et al. Design scheme of a passive isotropic multi-strut vibration isolation platform constructed by three-parameter isolators based on the optimum damping frequency concept. Journal of Vibration and Control, 2018, 24(17): 3942–3943.

J Ji, Y Wu, K Yu et al. Dynamic modeling and experimental analyses of stewart platform with flexible hinges. Journal of Vibration and Control, 2018, 25(1): 151–171.

Q Luo, D Li, W Zhou. Studies on vibration isolation for a multiple flywheel system in variable configurations. Journal of Vibration and Control, 2015, 21(11): 105–123.

Z Qiu, J Yang, X Zhang. Self-excited vibration control of the flexible planar parallel 3-rrr robot. Journal of Vibration and Control, 2019, 25(2): 351–361.

C Wang, X Xie, Y Chen et al. Investigation on active vibration isolation of a stewart platform with piezoelectric actuators. Journal of Sound and Vibration, 2016, 383(21-22): 2758–2768.

S Xu, G Sun, and Z Li. Finite frequency vibration suppression for space flexible structures in tip position control. International Journal of Control, Automation and Systems, 2018, 16: 1021–1029.

J Dong, J Xu, Q Zhou et al. Physical human-robot interaction force control method based on adaptive variable impedance. Journal of the Franklin Institute, 2020, 357(12): 7864–7878.

H Deng, G Xin, G Zhong et al. Gait and trajectory rolling planning and control of hexapod robots for disaster rescue applications. Robotics and Autonomous Systems, 2017, 95: 13–24.

M Trumic, K Jovanovic, A Fagiolini. Decoupled nonlinear adaptive control of position and stiffness for pneumatic soft robots. The International Journal of Robotics Research, 2020, 40(1): 277–295.

J Duan, Y Gan, M Chen et al. Adaptive variable impedance control for dynamic contact force tracking in uncertain environment. Robotics and Autonomous Systems, 2018, 102: 54–65.

Z Li, J Liu, Z Huang et al. Adaptive impedance control of human-robot cooperation using reinforcement learning. IEEE Transactions on Industrial Electronics, 2017, 64(10): 8013–8022.

H Peng, J Wang, S Wang et al. Coordinated motion control for a wheel-leg robot with speed consensus strategy. IEEE/ASME Transactions on Mechatronics, 2020, 25(3): 1366–1376.

B Heinrichs, N Sepehri, A B Thornton-Trump. Position-based impedance control of an industrial hydraulic manipulator. IEEE Control Systems Magazine, 1997, 17(1): 46–52.