Convex Optimization Solution for Inverse Kinematics of a Physically Constrained Redundant Manipulator
CAO Pengfei1,2, GAN Yahui1,2, DAI Xianzhong1,2, DUAN Jinjun1,2
1. School of Automation, Southeast University, Nanjing 210096, China;
2. Key Laboratory of Measurement and Control of Complex Systems of Engineering, Ministry of Education, Nanjing 210096, China
Abstract:Results of redundant manipulator inverse kinematics are likely to exceed the manipulator's physical constraints. To acquire inverse kinematics solution subject to physical bounds, a method using convex optimization is adopted. Firstly, the relation between joint velocity and torque is analyzed, and the manipulator kinetic energy and the repetitive motion are adopted as the optimization criteria, with joint velocity and joint torque as the optimization variables. Then the inverse kinematics problem is transformed into a convex optimization problem and further transformed into a quadratic programming problem. Taking full advantage of the redundancy of the manipulator, physical constraints including the joint position, joint velocity and joint torque are avoided in solving the inverse kinematics. Finally, simulation experiment is carried out on a 7-DOF redundant manipulator KUKA LBR iiwa. Results of the obtained joint variables satisfy the physical constraints and the optimization criteria. The result shows that the proposed method is suitable for solving inverse kinematics of physically constrained redundant manipulator.
[1] Liegeois A. Automatic supervisory control of the configuration and behavior of multibody mechanisms[J]. IEEE Transactions on Systems, Man, and Cybernetics, 1977, 7(12): 868-871.
[2] 赵占芳,张启先.冗余自由度机器人的运动学优化研究[J].北京理工大学学报,1995,15(4):409-414.Zhao Z F, Zhang Q X. Kinematics optimization for redundant robot[J]. Journal of Beijing Institute of Technology, 1995, 15(4): 409-414.
[3] 王勇,王蕾,许蕴梅.冗余自由度机器人的运动学逆解[J].山东大学学报:工学版,2003,33(3):249-252.Wang Y, Wang L, Xu Y M. Inverse kinematics algorithm of redundant robot[J]. Journal of Shandong University: Engineering Science, 2003, 33(3): 249-252.
[4] 陈启军,王月娟,李自育,等.避免关节限制的机器人冗余分解方法[J].同济大学学报:自然科学版,2000,28(1):41-45.Chen Q J, Wang Y J, Li Z Y, et al. Comparative research of kinematic redundancy resolution strategy of robotic manipulators for avoiding joint limits[J]. Journal of Tongji University: Natural Science, 2000, 28(1): 41-45.
[5] Wang J, Li Y, Zhao X. Inverse kinematics and control of a 7-DOF redundant manipulator based on the closed-loop algorithm[J]. International Journal of Advanced Robotic Systems, 2010, 7(4): 1-9.
[6] 阳方平,李洪谊,王越超,等.一种求解冗余机械臂逆运动学的优化方法[J].机器人,2012,34(1):17-21.Yang F P, Li H Y, Wang Y C, et al. An optimization method for solving the inverse kinematics of redundant manipulator[J]. Robot, 2012, 34(1): 17-21.
[7] 潘博,付宜利,杨宗鹏,等.面向冗余机器人实时控制的逆运动学求解有效方法[J].控制与决策,2009,24(2):176-180.Pan B, Fu Y L, Yang Z P, et al. Efficient inverse kinematics solution for redundant robots to real-time control[J]. Control and Decision, 2009, 24(2): 176-180.
[8] 陈鹏,刘璐,余飞,等.一种仿人机械臂的运动学逆解的几何求解方法[J].机器人,2012,34(2):211-216.Chen P, Liu L, Yu F, et al. A geometrical method for inverse kinematics of a kind of humanoid manipulator[J]. Robot, 2012, 34(2): 211-216.
[9] 张雨浓,符刚,尹江平.基于双判据优化方法的机器人逆运动学求解[J].大连海事大学学报:自然科学版,2007,33(3): 1-5.Zhang Y N, Fu G, Yin J P. A solution to robotic inverse-kinematic problem using bi-criteria weighted optimization[J]. Journal of Dalian Maritime University: Natural Science, 2007, 33(3): 1-5.
[10] Singh G K, Claassens J. An analytical solution for the inverse kinematics of a redundant 7DoF manipulator with link offsets [C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2010: 2976-2982.
[11] Debrouwere F, van Loock W, Pipeleers G, et al. Time-optimal path following for robots\columnbreak with convex-concave constraints using sequential convex programming[J]. IEEE Transactions on Robotics, 2013, 29(6): 1485-1495.
[12] Yoshikawa T. Manipulability of robotic mechanisms[J]. International Journal of Robotics Research, 1985, 4(2): 3-9.
[13] Maciejewski A A, Klein C A. Obstacle avoidance for kinematically redundant manipulators in dynamically varying environments[J]. International Journal of Robotics Research, 1985, 4(3): 109-117.
[14] Nedungadi A, Kazerouinian K. A local solution with global characteristics for the joint torque optimization of a redundant manipulator[M]//Advanced Robotics: 1989. Berlin, Germany: Springer-Verlag, 1989: 559-591.
[15] Zhang Y, Guo D. Linear programming versus quadratic programming in robots' repetitive redundancy resolution: A chattering phenomenon investigation[C]//4th IEEE Conference on Industrial Electronics and Applications. Piscataway, USA: IEEE, 2009: 2822-2827.
[16] Grant M, Boyd S, Ye Y. CVX: Matlab software for disciplined convex programming[OL]. (2015-06-01) [2015-10-21]. http://cvxr.com/cvx/.
[17] Zhang Y, Wang J, Xia Y. A dual neural network for redundancy resolution of kinematically redundant manipulators subject to joint limits and joint velocity limits[J]. IEEE Transactions on Neural Networks, 2003, 14(3): 658-667.
[18] Liu S, Wang J. Bi-criteria torque optimization of redundant manipulators based on a simplified dual neural network[C]//IEEE International Joint Conference on Neural Networks, vol.5. Piscataway, USA: IEEE, 2005: 2796-2801.
[19] Hou Z G, Cheng L, Tan M. Multicriteria optimization for coordination of redundant robots using a dual neural network[J]. IEEE Transactions on Systems, Man, and Cybernetics, Part B: Cybernetics, 2010, 40(4): 1075-1087.
[20] Craig J J. Introduction to robotics: Mechanics and control[M]. Upper Saddle River, USA: Prentice Hall, 2005.
[21] Buondonno G, De Luca A. A recursive Newton-Euler algorithm for robots with elastic joints and its application to control[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2015: 5526-5532.