针对六足并联机器人冗余驱动问题，提出以降低能耗，提高承载能力为目标的驱动力优化分配方法。通过建立六足并联机器人运动学与动力学模型，得到机器人关节驱动力与脚力间转换关系。在分析机器人动态平衡条件并考虑摩擦约束、最大驱动力约束及触地约束的基础上，建立以驱动力平方和最小为目标函数的二次规划问题。基于QR分解的广义消去法消去等式约束减少约束方程的数量以提高优化问题的求解速度，采用对偶理论将问题转化为对偶二次规划问题可以进一步提高求解速度。分析了多足机器人与多指灵巧手动力学模型的不同，因此两者的二次规划目标函数也存在不同。同时与传统的以内力最小为目标函数的方法比较，表明该方法能够充分利用地面摩擦力以减小驱动力，从而提高承载能力，降低能量消耗。
The active forces distribution algorithm for improving bearing capability and minimizing energy consumption is proposed to solve the redundant actuation problem of a six-parallel-legged robot. The transformation between active joint forces and foot contact forces is established based on the kinematic model and dynamic model. After analyzing the force/moment equilibrium equations of the robot, the quadratic programming optimization model is obtained considering the constraints of friction cone, unilateral constraint and the limits of motors' torques. The solving time of the quadratic programming is reduced by eliminating and simplifying equality and inequality constraints using elimination method based on QR decomposition and dual method. The difference between the objective function of multi-legged robots and multi-finger hands is pointed out because of the difference of their dynamic models. Compared with the traditional method, the proposed algorithm has great advantages in improving bearing capability and minimizing energy consumption due to the efficient utilizing of the contact friction forces.
[1] ZHAO Yongsheng, LU Ling, ZHAO Tieshi, et al. The novel approaches for computing the dynamic load-carrying capacity of multiple cooperating robotic manipulators[J]. Mechanism and Machine Theory, 1999, 34(4):637-643.
[2] ZHAO Yongsheng, REN Jingyi, HUANG Zhen. Dynamic loads coordination for multiple cooperating robot manipulators[J]. Mechanism and Machine Theory, 2000, 35(7):985-995.
[3] ORIN D E, OH S Y. Control of force distribution in robotic mechanisms containing closed kinematic chains[J]. Journal of Dynamic Systems, Measurement, and Control, 1981, 103(2):134-141.
[4] KLEIN C A, KITTIVATCHARAPONG S. Optimal force distribution for the legs of a walking machine with friction cone constraints[J]. Robotics and Automation, IEEE Transactions on, 1990, 6(1):73-85.
[5] CHENG F T, ORIN D E. Optimal force distribution in multiple-chain robotic systems[J]. Systems, Man and Cybernetics, IEEE Transactions on, 1991, 21(1):13-24.
[6] CHENG F T, ORIN D E. Efficient algorithm for optimal force distribution-the compact-dual LP method[J]. Robotics and Automation, IEEE Transactions on, 1990, 6(2):178-187.
[7] NAHON M A, ANGELES J. Optimization of dynamic forces in mechanical hands[J]. Journal of Mechanical Design, 1991, 113(2):167-173.
[8] NAHON M A, ANGELES J. Real-time force optimization in parallel kinematic chains under inequality constraints[J]. Robotics and Automation, IEEE Transactions on, 1992, 8(4):439-450.
[9] CHEN Xuedong, WATANABE K, KIGUCHI K, et al. Optimal force distribution for the legs of a quadruped robot[J]. Machine Intelligence and Robotic Control, 1999, 1(2):87-93.
[10] KAR D C, KURIEN I K, JAYARAJAN K. Minimum energy force distribution for a walking robot[J]. Journal of Robotic Systems, 2001, 18(2):47-54.
[11] ROY S S, SINGH A K, PRATIHAR D K. Estimation of optimal feet forces and joint torques for on-line control of six-legged robot[J]. Robotics and Computer-Integrated Manufacturing, 2011, 27(5):910-917.
[12] ROY S S, PRATIHAR D K. Dynamic modeling, stability and energy consumption analysis of a realistic six-legged walking robot[J]. Robotics and Computer-Integrated Manufacturing, 2013, 29(2):400-416.
[13] DE SANTOS P G, COBANO J A, GARCIA E, et al. A six-legged robot-based system for humanitarian demining missions[J]. Mechatronics, 2007, 17(8):417-430.
[14] HEVERLY M, MATTHEWS J, FROST M, et al. Development of the tri-ATHLETE lunar vehicle prototype[C]//Proceedings of the 40th Aerospace Mechanisms Symposium, 2010:317-326.
[15] PORTA J M, CELAYA E. Reactive free-gait generation to follow arbitrary trajectories with a hexapod robot[J]. Robotics and Autonomous Systems,2004,47(4):187-201.
[16] FUJⅡ S, INOUE K, TAKUBO T, et al. Climbing up onto steps for limb mechanism robot ASTERISK[C]//Proc. 23rd Int. Symp. on Automation and Robotics in Construction, 2006:225-230.
[17] LI Meng, HUANG Tian, MEI Jiangping, et al. Dynamic formulation and performance comparison of the 3-DOF modules of two reconfigurable PKM-the Tricept and the TriVariant[J]. Journal of Mechanical Design, 2005, 127(6):1129-1136.
[18] HUANG Tian, LI Meng, ZHAO Xueman, et al. Conceptual design and dimensional synthesis for a 3-DOF module of the TriVariant-a novel 5-DOF reconfigurable hybrid robot[J]. Robotics, IEEE Transactions on, 2005, 21(3):449-456.
[19] YANG P, FENG G. A new 6-parallel-legged walking robot for drilling holes on the fuselage[J]. ARCHIVE Proceedings of the Institution of Mechanical Engineers Part C,Journal of Mechanical Engineering Science,2013, 228(4):753-764.
[20] DE SANTOS P G, ESTREMERA J, GARCIA E. Optimizing leg distribution around the body in walking robots[C]//Robotics and Automation, 2005, ICRA 2005. Proceedings of the 2005 IEEE International Conference on, IEEE, 2005:3207-3212.
