Motion-distribution method in triple-trajectory tracking of a high redundant non-holonomic MDAMs under joint limits

This paper presents a motion distribution-based triple-trajectory tracking method for a high redundant Mobile Dual-Arm Manipulator System (MDAMs) which acts as a personal assistant. The MDAMs consists of one non-holonomic mobile platform, one holonomic body with a moving waist, two 7-DoFs arms and two dexterous hands. Inspired by human movement determination, a new subtask is introduced, i.e., the relative motion of the right end-effector (EE) with respect to its body frame. Two relative task variables are introduced which allow the control of the right EE in the world frame and the left EE with respect to the right EE. Moreover, two compact relative Jacobian matrices are constructed to link the joint space with the task space. Furthermore, the task-priority based inverse kinematic (IK) solving method is applied by using pseudo-inverse Jacobian matrix. Finally, a semi-decentralized control law is proposed for the MDAMs with kinematic control law for the mobile part. This paper builds a mathematical MDAMs model and numerically simulates a triple-trajectory tracking by using the proposed control law. The simulation results validate the effectiveness of the triple-trajectory tracking control method.

[1]  Darwin G. Caldwell,et al.  Modular relative Jacobian for dual-arms and the wrench transformation matrix , 2015, 2015 IEEE 7th International Conference on Cybernetics and Intelligent Systems (CIS) and IEEE Conference on Robotics, Automation and Mechatronics (RAM).

[2]  Frank L. Lewis,et al.  Control of a nonholonomic mobile robot: backstepping kinematics into dynamics , 1995, Proceedings of 1995 34th IEEE Conference on Decision and Control.

[3]  Christopher L. Lewis.  Trajectory generation for two robots cooperating to perform a task , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[4]  Rajiv V. Dubey,et al.  A weighted least-norm solution based scheme for avoiding joint limits for redundant joint manipulators , 1993, IEEE Trans. Robotics Autom..

[5]  Rodrigo S. Jamisola,et al.  A more compact expression of relative Jacobian based on individual manipulator Jacobians , 2015, Robotics Auton. Syst..

[6]  Pyung Hun Chang,et al.  Guaranteeing task prioritization for redundant robots given maximum number of tasks and singularities , 2012, TENCON 2012 IEEE Region 10 Conference.

[7]  C.L. Lewis,et al.  Trajectory generation for cooperating robots , 1990, 1990 IEEE International Conference on Systems Engineering.

[8]  Rodrigo S. Jamisola,et al.  Investigating task prioritization and holistic coordination using relative Jacobian for combined 3-arm cooperating parallel manipulators , 2015, 2015 International Conference on Humanoid, Nanotechnology, Information Technology,Communication and Control, Environment and Management (HNICEM).

[9]  L. Notash,et al.  Failure recovery of manipulators under joint velocity limits using constrained optimization and partitioned Jacobian matrix , 2016 .

[10]  Gianluca Antonelli,et al.  Prioritized closed-loop inverse kinematic algorithms for redundant robotic systems with velocity saturations , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Francesco Basile,et al.  Task-oriented motion planning for multi-arm robotic systems , 2012 .

[12]  Ronan Boulic,et al.  Task-priority formulations for the kinematic control of highly redundant articulated structures , 1998, Proceedings. 1998 IEEE/RSJ International Conference on Intelligent Robots and Systems. Innovations in Theory, Practice and Applications (Cat. No.98CH36190).

[13]  Pyung Hun Chang,et al.  Relative Impedance Control for Dual-Arm Robots Performing Asymmetric Bimanual Tasks , 2014, IEEE Transactions on Industrial Electronics.

[14]  Beno Benhabib,et al.  Acceleration and torque redistribution for a dual-manipulator system , 2005, IEEE Transactions on Robotics.

[15]  Oussama Khatib,et al.  Control of Redundant Robots Under Hard Joint Constraints: Saturation in the Null Space , 2015, IEEE Transactions on Robotics.

[16]  Minzhou Luo,et al.  A unified dynamic control method for a redundant dual arm robot , 2015 .

[17]  Bruno Siciliano,et al.  Task-Oriented Kinematic Control of Two Cooperative 6-DOF Manipulators , 1993, 1993 American Control Conference.

[18]  T. Yoshikawa,et al.  Task-Priority Based Redundancy Control of Robot Manipulators , 1987 .

[19]  Yang Qian,et al.  Design and Control of a Personal Assistant Robot , 2013 .

[20]  Pyung Hun Chang,et al.  Relative task prioritization for dual-arm with multiple, conflicting tasks: Derivation and experiments , 2013, 2013 IEEE International Conference on Robotics and Automation.

[21]  Sungchul Kang,et al.  Two-arm cooperative assembly using force-guided control with adaptive accommodation , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

[22]  Rajiv Dubey,et al.  Mobile manipulator dual-trajectory tracking using control variables introduced to end-effector task vector , 2016, 2016 World Automation Congress (WAC).

[23]  J.S. Yuan,et al.  Closed-loop manipulator control using quaternion feedback , 1988, IEEE J. Robotics Autom..

[24]  M. Boukattaya,et al.  Dynamic redundancy resolution for mobile manipulators with joints velocity limits avoidance , 2008, 2008 5th International Multi-Conference on Systems, Signals and Devices.

[25]  Guang-Zhong Yang,et al.  Task-priority redundancy resolution for co-operative control under task conflicts and joint constraints , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[26]  Henk Nijmeijer,et al.  Mutual synchronization of robots via estimated state feedback: a cooperative approach , 2004, IEEE Transactions on Control Systems Technology.

[27]  Ji Xiang,et al.  Clamping weighted least-norm method for the manipulator kinematic control: Avoiding joint limits , 2014, Proceedings of the 33rd Chinese Control Conference.