|
|
Second order inverse kinematic control method for non redundant manipulator with joint constraints |
JIANG Pei1,2, HUANG Shui hua1, WEI Wei1, SHAN Cai hua3, XIANG Ji1 |
1. College of Electrical Engineering, Zhejiang University, Hangzhou 310027, China;2. State Key Laboratory of Mechanical Transmission, Chongqing University, Chongqing 400030, China; 3. Zhejiang Zhengte Group Limited Company, Taizhou 317004, China |
|
|
Abstract A second order inverse kinematic control algorithm was proposed in order to control non redundant manipulator with both joint limit and joint velocity constraints. The joint limit constraint was converted into the joint velocity constraint with time variant thresholds. Then real joint space was mapped into the revised joint space, in which joint limit constraint can be guaranteed by the weighted least norm method. The method can achieve joint velocity constraint by adjusting the weight factors. A further proof that the both joint limit constraint and joint velocity constraint can be guaranteed by the method. A simulation was conducted on a three link non redundant manipulator in order to track a predefined trajectory. Results demonstrated that the method successfully guaranteed both joint limit constraint and joint velocity constraint.
|
Published: 29 October 2015
|
|
针对关节限位和关节速度约束下的非冗余机械手臂控制问题,提出能够同时满足关节限位、关节速度约束的非冗余机械手臂二阶逆运动学算法.该算法将关节限位约束转换为带有时变阈值的关节速度约束,将时变阈值关节速度约束由真实关节空间映射到修正关节空间,变为固定阈值的关节速度约束;在修正关节空间通过加权最小二乘法,保证机械手臂运动过程中关节限位约束成立.该算法能够通过自适应调整权值矩阵满足关节速度约束,通过定理证明了该算法能够充分满足关节限位、关节速度约束.在三关节非冗余机械手臂上进行仿真实验,验证了该算法可以使闭环系统在实现轨迹跟踪的过程中保证关节限位、关节速度约束成立.
|
|
[1] WHITNEYD E. Resolved motion rate control of manipulators and human prostheses [J]. IEEE Transactions Human Machine Systems, 1969, 10(2): 47-53.
[2] 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.
[3] NAKAMURA Y, HANAFUSA H. Optimal redundancy control of robot manipulators [J]. The International Journal of Robotics Research, 1987, 6(1): 32-42.
[4] 姜宏超,刘士荣,张波涛.六自由度模块化机械臂的逆运动学分析[J].浙江大学学报:工学版,2010,44(7):1348-1354.
JIANG Hong chao, LIU Shi rong, ZHANG Bo tao.Inverse kinematics analysis for 6 degree of freedom modular manipulator [J]. Journal of Zhejiang University:Engineering Science, 2010, 44(7): 1348-1354.
[5] HOLLERBACH J M, KI S. Redundancy resolution ofmanipulators through torque optimization [J]. IEEE Journal of Robotics and Automation, 1987, 3(4): 308-316.
[6] HSU P, MAUSER J, SASTRY S. Dynamic control of redundant manipulators [J]. Journal of Robotic Systems, 1989, 6(2): 133-148.
[7] CACCAVALE F, CHIAVERINI S, SICILIANO B. Second order kinematic control of robot manipulators with Jacobian damped least squares inverse: theory and experiments [J]. IEEE/ASME Transactions on Mechatronics, 1997, 2(3): 188-194.
[8] GUO Dong sheng, ZHANG Yu nong. Acceleration level inequality based MAN scheme for obstacle avoidance of redundant robot manipulators [J]. IEEE Transactions on Industrial Electronics, 2014, 61(12): 6903-6914.
[9] CHAN Tan fung, DUBEY R V. A weighted least norm solution based scheme for avoiding joint limits for redundant joint manipulators [J]. IEEE Transactions onRobotics and Automation, 1995, 11(2): 286-292.
[10] HUANG Shui hua, PENG Yong gang, WEI Wei, et al. Clamping weighted least norm method for themanipulator kinematic control: avoiding joint limits [C]∥ Proceedings of the 33th Chinese Control Conference. Nanjing: [s. n.], 2014: 8309-8314.
[11] XIANG Ji, ZHONG Cong wei, WEI Wei. A varied weights method for the kinematic control of redundant manipulators with multiple constraints [J]. IEEE Transactions on Robotics, 2012, 28(2): 330-340.
[12] KIRCANSKI M, KIRCANSKI N. Resolved rate and resolved acceleration based robot control in the presence of actuators’ constraints [C]∥Proceedings of IEEE International Conference on Robotics and Automation. Albuquerque: IEEE, 1997: 235-240.
[13] ANTONELLI G, CHIAVERINI S, FUSCO G. A new on line algorithm for inverse kinematics of robot manipulators ensuring path tracking capability under joint limits [J]. IEEE Transactions on Robotics and Automation, 2003, 19(1): 162-167.
[14] BIANCO C G L, GERELLI O. Online trajectory scaling for manipulators subject to high order kinematic and dynamic constraints [J]. IEEE Transactions onRobotics and Automation, 2011, 27(6): 1144-1152.
[15] BIANCO C G L, GHILARDELLI F. Real time planner in the operational space for the automatic handling of kinematic constraints [J]. IEEE Transactions on Automation Science and Engineering, 2014, 11(3): 730-739.
[16] KHALIL H K, GRIZZLE J W. Nonlinear systems [M]. Upper Saddle River: Prentice hall, 2002.
[17] O’NEIL K A. Divergence of linear acceleration based redundancy resolution schemes [J]. IEEE Transactions on Robotics and Automation, 2002, 18(4): 625-631.
|
|
Viewed |
|
|
|
Full text
|
|
|
|
|
Abstract
|
|
|
|
|
Cited |
|
|
|
|
|
Shared |
|
|
|
|
|
Discussed |
|
|
|
|