Dynamic modelling and PFL-based trajectory tracking control for underactuated cable-driven truss-like manipulator

Abstract

In recent years, an innovative underactuated robot was developed, named as underactuated cable-driven truss-like manipulator (UCTM), to be suitable in aerospace applications. However, there has been strong consensus that the stabilization of planar underactuated manipulators without gravity is a great challenge since the system includes a second order nonholonomic constraint and most classical control methods are not suitable for this kind of system. Furthermore, the complexity of the truss-like structure results in tremendous difficulty of computational complicacy and high nonlinearity during dynamic modelling in addition to controller design. It is paramount to solve these difficulties for UCTM’s future applications. To solve the above difficulties, this paper presents a dynamic modelling method for UCTM and a trajectory tracking control method based on partial feedback linearization (PFL) that fulfills the control goal of moving UCTM from its original position to a desired position by tracking a given trajectory of the joint angles. To achieve this, a model equivalent method is proposed to make UCTM equivalent with a three-link manipulator in the sense of dynamic behavior. Then the Lagrangian equation combined with complex vector method is proposed in the dynamic modelling process of UCTM, which simplifies the derivation procedure. Based on the established dynamic model, a coordinate transformation method is proposed to transform the control force matrix into the conventional form of an underactuated system, so that the control force can be separated from the unactuated term. The PFL method in combination with the LQR control method is then proposed to realize the targets that the joint angles can track given desired trajectory. Simulation experiments are conducted to verify the correctness and effectiveness of the proposed methods.

Keywords

underactuated robot / trajectory tracking control / partial feedback linearization / non-linear control

References

[1] HeB, WangS, LiuY-J. Underactuated robotics: A review. International Journal of Advanced Robotic Systems, 2019, 16(4): 172988141986216

[2] XiaY, LiuR-Q, GuoH-W, DengZ-Q. Design and analysis of an under-actuated self-adaptive mechanical hand. Applied Mechanics and Materials, 2014, 602–605: 1083-1089

[3] WuN, LiuR-Q, GuoH-W. Statics and grasp stiffness analysis of an underactuated cable-truss mechanism. Applied Mechanics and Materials, 2014, 597507-514

[4] WuN, LiuR-Q, GuoH-W. The design and kinematics analysis of an underactuated cable-truss mechanism. Advanced Materials Research, 2014, 915–916: 256-263

[5] LÜ X, QIAO Shang-ling, SHI Yu-ming, LIU Rong-qiang. Characteristics research of an underactuated manipulator basing on the statics and dynamics analysis [C]// 2016 IEEE International Conference on Mechatronics and Automation. IEEE, 2016: 772–776. DOI: https://doi.org/10.1109/ICMA.2016.7558660.

[6] QIAO Shang-ling, GUO Hong-wei, LIU Rong-qiang, DENG Zong-quan. Analysis of the influence of parameters change on effective grasping force of an underactuated robotic hand [C]// 2016 IEEE International Conference on Robotics and Biomimetics (ROBIO). IEEE, 2016: 396–401. DOI: https://doi.org/10.1109/ROBIO.2016.7866354.

[7] QIAO Shang-ling, GUO Hong-wei, LIU Rong-qiang, DENG Zong-quan. Research of the relation between configuration and skin-friction coefficient of an underactuated hand based on the maximum grasping space [C]// Mechanism and Machine Science, 2017. DOI: https://doi.org/10.1007/978-981-10-2875-5_8.

[8] ZhangC-J, WangC, WeiY-J, WangJ-Q. Neural network adaptive position tracking control of underactuated autonomous surface vehicle. Journal of Mechanical Science and Technology, 2020, 34(2): 855-865

[9] AdamskiW, PazderskiD, HermanP. Robust 3D tracking control of an underactuated autonomous airship. IEEE Robotics and Automation Letters, 2020, 5(3): 4281-4288

[10] WiigM S, PettersenK Y, KrogstadT R. A 3D reactive collision avoidance algorithm for underactuated underwater vehicles. Journal of Field Robotics, 2020, 37(6): 1094-1122

[11] WangY-W, YangH-Q, ZhangP. Iterative convergence control method for planar underactuated manipulator based on support vector regression model. Nonlinear Dynamics, 2020, 102(4): 2711-2724

[12] HuangZ-X, LaiX-Z, ZhangP, MengQ-X, WuM. A general control strategy for planar 3-DoF underactuated manipulators with one passive joint. Information Sciences, 2020, 534: 139-153

[13] GuptaS, KumarA. A brief review of dynamics and control of underactuated biped robots. Advanced Robotics, 2017, 31(12): 607-623

[14] ChevallereauC. Time-scaling control for an underactuated biped robot. IEEE Transactions on Robotics and Automation, 2003, 19(2): 362-368

[15] PappalardoC M, GuidaD. On the dynamics and control of underactuated nonholonomic mechanical systems and applications to mobile robots. Archive of Applied Mechanics, 2019, 89(4): 669-698

[16] XinX. Analysis of the energy based swing-up control for a double pendulum on a cart. Proceedings Volumes, 2008, 41(2): 4828-4833

[17] SpongM W. Energy based control of a class of underactuated mechanical systems. IFAC Proceedings Volumes, 1996, 29(1): 2828-2832

[18] ZhangY-Y, LiS. Time-scale expansion-based approximated optimal control for underactuated systems using projection neural networks. IEEE Transactions on Systems, Man, and Cybernetics: Systems, 2018, 48(11): 1957-1967

[19] HuangJ, RiS, FukudaT, WangY-J. A disturbance observer based sliding mode control for a class of underactuated robotic system with mismatched uncertainties. IEEE Transactions on Automatic Control, 2019, 64(6): 2480-2487

[20] AshtianiH D, MobayenS. Design of an adaptive super-twisting decoupled terminal sliding mode control scheme for a class of fourth-order systems. ISA Transactions, 2018, 75: 216-225

[21] MobayenS. Design of LMI-based sliding mode controller with an exponential policy for a class of underactuated systems. Complexity, 2016, 21(5): 117-124

[22] MobayenS. A novel global sliding mode control based on exponential reaching law for a class of underactuated systems with external disturbances. Journal of Computational and Nonlinear Dynamics, 2016, 11(2): 021011

[23] KhanQ, AkmeliawatiR, BhattiA I, KhanM A. Robust stabilization of underactuated nonlinear systems: A fast terminal sliding mode approach. ISA Transactions, 2017, 66: 241-248

[24] RavichandranM T, MahindrakarA D. Robust stabilization of a class of underactuated mechanical systems using time scaling and Lyapunov redesign. IEEE Transactions on Industrial Electronics, 2011, 58(9): 4299-4313

[25] YangS-Y, HanJ, XiaL, ChenY H. Adaptive robust servo constraint tracking control for an underactuated quadrotor UAV with mismatched uncertainties. ISA Transactions, 2020, 10612-30

[26] RudraS, KumarB R, MaitraM. Nonlinear state feedback controller design for underactuated mechanical system: A modified block backstepping approach. ISA Transactions, 2014, 53(2): 317-326

[27] JIANG Jing-jing, ASTOLFI A. Under-actuated back-stepping: An introduction [C]//2018 IEEE Conference on Decision and Control (CDC). IEEE, 2018: 5910–5915. DOI: https://doi.org/10.1109/CDC.2018.8619350.

[28] HuangX-F, RalescuA L, GaoH-L, HuangH-B. A survey on the application of fuzzy systems for underactuated systems. Proceedings of the Institution of Mechanical Engineers, Part I: Journal of Systems and Control Engineering, 2019, 233(3): 217-244

[29] DingS-C, HuangX-L, BanX-J, LuH-Q, ZhangH-Y. Type-2 fuzzy logic control for underactuated truss-like robotic finger with comparison of a type-1 case¹. Journal of Intelligent & amp; Fuzzy Systems, 2017, 33(4): 2047-2057

[30] AzimiM M, KoofigarH R. Adaptive fuzzy backstepping controller design for uncertain underactuated robotic systems. Nonlinear Dynamics, 2015, 79(2): 1457-1468

[31] WangY-Y, ShenH, KarimiH R, DuanD-P. Notice of violation of IEEE publication principles: Dissipativity-based fuzzy integral sliding mode control of continuous-time T-S fuzzy systems. IEEE Transactions on Fuzzy Systems, 2018, 26(3): 1164-1176

[32] SPONG M W. Partial feedback linearization of underactuated mechanical systems [C]// Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS’94). IEEE, 1994: 314–321. DOI: https://doi.org/10.1109/IROS.1994.407375.

[33] LeT A, KimG H, KimM Y, LeeS G. Partial feedback linearization control of overhead cranes with varying cable lengths. International Journal of Precision Engineering and Manufacturing, 2012, 13(4): 501-507

[34] S P, ThampattyK C S, NambiarT N P. Design and implementation of partial feedback linearization controller for unified power flow controller. Electric Power Systems Research, 2020, 187: 106438

[35] PhamD B, KimJ, LeeS G. Combined control with sliding mode and partial feedback linearization for a spatial ridable ballbot. Mechanical Systems and Signal Processing, 2019, 128531-550

[36] PhamD B, WeonI S, LeeS G. Partial feedback linearization double-loop control for a pseudo-2D ridable ballbot. International Journal of Control, Automation and Systems, 2020, 18(5): 1310-1323

[37] VujovicV, RosendoA, BrodbeckL, IidaF. Evolutionary developmental robotics: Improving morphology and control of physical robots. Artificial Life, 2017, 23(2): 169-185

[38] XiangX-B, LapierreL, JouvencelB. Smooth transition of AUV motion control: From fully-actuated to under-actuated configuration. Robotics and Autonomous Systems, 2015, 67: 14-22

[39] ZhangM-H, MaX, RongX-W, TianX, LiY-B. Error tracking control for underactuated overhead cranes against arbitrary initial payload swing angles. Mechanical Systems and Signal Processing, 2017, 84: 268-285

[40] TavakoliM, EnesB, SantosJ, MarquesL, de AlmeidaA T. Underactuated anthropomorphic hands. Robotics & amp; Autonomous Systems, 2015, 74: 267-282

[41] CatalanoM G, GrioliG, FarnioliE, SerioA, PiazzaC, BicchiA. Adaptive synergies for the design and control of the Pisa/IIT SoftHand. The International Journal of Robotics Research, 2014, 33(5): 768-782

[42] OzawaR, MishimaY, HiranoY. Design of a transmission with gear trains for underactuated mechanisms. IEEE Transactions on Robotics, 2016, 32(6): 1399-1407

[43] WeiY, MaY, ZhangW. A multi-jointed underactuated robot hand with fluid-driven stretchable tubes. Robotics and Biomimetics, 2018, 5(1): 2

[44] REN Ze-yu, ZHOU Cheng-xu, XIN Song-yan, TSAGARAKIS N. HERI hand: A quasi dexterous and powerful hand with asymmetrical finger dimensions and under actuation [C]// 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2017: 322–328. DOI: https://doi.org/10.1109/IROS.2017.8202175.

[45] KuindersmaS, DeitsR, FallonM, ValenzuelaA, DaiH K, PermenterF, KoolenT, MarionP, TedrakeR. Optimization-based locomotion planning, estimation, and control design for the atlas humanoid robot. Autonomous Robots, 2016, 403429-455

[46] ŁUKOMSKI A W, OLEJNIK D. Trajectory design for nonlinear control of a bipedal walking robot [C]// 11th International Workshop on Robot Motion and Control (RoMoCo). 2017: 35–40. DOI: https://doi.org/10.1109/RoMoCo.2017.8003890.

[47] ZANG Xi-zhe, LIN Zhen-kun, LIU Yi-xiang, SUN Xin-ran, ZHAO Jie. Control strategy research for a biped walking robot with flexible ankle joints [C]// 2017 First IEEE International Conference on Robotic Computing (IRC). IEEE, 2017: 93–96. DOI: https://doi.org/10.1109/IRC.2017.9.

[48] HamedK A, GrizzleJ W. Event-based stabilization of periodic orbits for underactuated 3-D bipedal robots with left-right symmetry. IEEE Transactions on Robotics, 2014, 30(2): 365-381

[49] NaldiR, ForteF, SerraniA, MarconiL. Modeling and control of a class of modular aerial robots combining under actuated and fully actuated behavior. IEEE Transactions on Control Systems Technology, 2015, 23(5): 1869-1885

[50] ReyhanogluM, van der SchaftA, McclamrochN H, KolmanovskyI. Dynamics and control of a class of underactuated mechanical systems. IEEE Transactions on Automatic Control, 1999, 44(9): 1663-1671

[51] RigatosG G. Control and disturbances compensation in underactuated robotic systems using the derivative-free nonlinear Kalman filter. Robotica, 2017, 35(3): 687-711

[52] HamzaçebiH, MorgülÖ. On the periodic gait stability of a multi-actuated spring-mass hopper model via partial feedback linearization. Nonlinear Dynamics, 2017, 88(2): 1237-1256

[53] PucciD, RomanoF, NoriF. Collocated adaptive control of underactuated mechanical systems. IEEE Transactions on Robotics, 2015, 31(6): 1527-1536

[54] ZhangA-C, LaiX-Z, WuM, SheJ-H. Nonlinear stabilizing control for a class of underactuated mechanical systems with multi degree of freedoms. Nonlinear Dynamics, 2017, 89(3): 2241-2253

[55] ZhangA-C, LaiX-Z, WuM, SheJ-H. Stabilization of underactuated two-link gymnast robot by using trajectory tracking strategy. Applied Mathematics and Computation, 2015, 253: 193-204

[56] TahirN M, MuhammadM, IdiM, BuyaminS, Maijama’aL, YarimaS M. Comparative analysis of observer-based LQR and LMI controllers of an inverted pendulum. Bulletin of Electrical Engineering and Informatics, 2020, 9(6): 2244-2252

[57] REYES-VALERIA E, ENRIQUEZ-CALDERA R, CAMACHO-LARA S, GUICHARD J. LQR control for a quadrotor using unit quaternions: Modeling and simulation [C]// Conielecomp 2013, 23rd International Conference on Electronics, Communications and Computing. IEEE, 2013: 172–178. DOI: https://doi.org/10.1109/CONIELECOMP.2013.6525781.