Whole-Body Kinematic Control of Nonholonomic Mobile Manipulators Using Linear Programming

This paper presents some improvements to the robot kinematic control strategy based on linear programming, as well as its application to a nonholonomic mobile manipulator. In addition to being computationally efficient, this approach enables the inclusion of inequality and equality constraints in the system control inputs and has formal guarantee of stability. We first propose a new positive definite function of the error variation to avoid joint movements when the robot end-effector stabilizes at a point different from the desired one. In addition, the nonholonomic constraint of the mobile base is imposed as an equality constraint, and inequality constraints are defined to avoid both violation of joint limits and collisions between the mobile base and obstacles in the plane. Last, a performance comparison between the linear programming strategy and an approach based on the pseudoinverse of the whole-body Jacobian matrix is presented. Experimental results show that the controller based on linear programming has low computational cost, and the robot is able to control its end-effector without colliding with obstacles in the plane and without violating its joints limits. However, it tends to generate more abrupt control signals than the continuous controller based on the pseudoinverse of the whole-body Jacobian matrix.

[1]  Russell H. Taylor,et al.  A Perspective on Medical Robotics , 2006, Proceedings of the IEEE.

[2]  André Crosnier,et al.  Parsimonious Kinematic Control of Highly Redundant Robots , 2016, IEEE Robotics and Automation Letters.

[3]  Mark Haigh-Hutchinson.  Position and orientation , 2009 .

[4]  Pierre-Brice Wieber,et al.  Fast resolution of hierarchized inverse kinematics with inequality constraints , 2010, 2010 IEEE International Conference on Robotics and Automation.

[5]  Russ Tedrake,et al.  Planning robust walking motion on uneven terrain via convex optimization , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[6]  Giuseppe Oriolo,et al.  Redundant Robots , 2016, Springer Handbook of Robotics, 2nd Ed..

[7]  J. M. Selig.  Geometric Fundamentals of Robotics , 2004, Monographs in Computer Science.

[8]  Junku Yuh,et al.  A general singularity avoidance framework for robot manipulators: task reconstruction method , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[9]  David G. Luenberger,et al.  Linear and nonlinear programming , 1984 .

[10]  Yangmin Li,et al.  A New Method of Executing Multiple Auxiliary Tasks by Redundant Nonholonomic Mobile Manipulators , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Yoshihiko Nakamura,et al.  Optimal Redundancy Control of Robot Manipulators , 1987 .

[12]  Homayoun Seraji,et al.  A Unified Approach to Motion Control of Mobile Manipulators , 1998, Int. J. Robotics Res..

[13]  Bruno Vilhena Adorno,et al.  A dual quaternion linear-quadratic optimal controller for trajectory tracking , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[14]  Taku Komura,et al.  Computing inverse kinematics with linear programming , 2005, VRST '05.

[15]  Ning Xi,et al.  Coordination of a nonholonomic mobile platform and an on-board manipulator , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[16]  Bruno Vilhena Adorno.  Two-arm Manipulation: From Manipulators to Enhanced Human-Robot Collaboration , 2011 .

[17]  James U. Korein,et al.  Robotics , 2018, IBM Syst. J..

[18]  Pierre-Brice Wieber,et al.  Hierarchical quadratic programming: Fast online humanoid-robot motion generation , 2014, Int. J. Robotics Res..

[19]  Yuval Rabani,et al.  Linear Programming , 2007, Handbook of Approximation Algorithms and Metaheuristics.

[20]  João Yoshiyuki Ishihara,et al.  Robust kinematic control of manipulator robots using dual quaternion representation , 2013, 2013 IEEE International Conference on Robotics and Automation.

[21]  Giuseppe Oriolo,et al.  The reduced gradient method for solving redundancy in robot arms , 1990, Robotersysteme.

[22]  Fan-Tien Cheng,et al.  Resolving manipulator redundancy under inequality constraints , 1994, IEEE Trans. Robotics Autom..

[23]  Jean-Jacques E. Slotine,et al.  A general framework for managing multiple tasks in highly redundant robotic systems , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[24]  Dragomir N. Nenchev,et al.  Balance Control of a Humanoid Robot Based on the Reaction Null Space Method , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  Alexander Dietrich,et al.  Singularity avoidance for nonholonomic, omnidirectional wheeled mobile platforms with variable footprint , 2011, 2011 IEEE International Conference on Robotics and Automation.

[26]  Giuseppe Oriolo,et al.  Kinematic control of nonholonomic mobile manipulators in the presence of steering wheels , 2010, 2010 IEEE International Conference on Robotics and Automation.

[27]  Bruno Siciliano,et al.  Kinematic control of redundant robot manipulators: A tutorial , 1990, J. Intell. Robotic Syst..

[28]  Giuseppe Oriolo,et al.  Control of redundant robots on cyclic trajectories , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[29]  Pierre-Brice Wieber,et al.  Kinematic Control of Redundant Manipulators: Generalizing the Task-Priority Framework to Inequality Task , 2011, IEEE Transactions on Robotics.

[30]  D. L. Donoho,et al.  Compressed sensing , 2006, IEEE Trans. Inf. Theory.

[31]  John Baillieul,et al.  Kinematic programming alternatives for redundant manipulators , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[32]  Philippe Fraisse,et al.  Dual position control strategies using the cooperative dual task-space framework , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[33]  A. De Luca,et al.  Fast redundancy resolution for high-dimensional robots executing prioritized tasks under hard bounds in the joint space , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[34]  E.R. Westervelt.  Robot Modeling and Control [Book Review] , 2006, IEEE Control Systems.

[35]  John F. Gardner,et al.  Kinematics of mobile manipulators and implications for design , 2000, J. Field Robotics.

[36]  Juan Jose Quiroz-Omana,et al.  Parsimonious Kinematic Control of Nonholonomic Mobile Manipulators , 2016, 2016 XIII Latin American Robotics Symposium and IV Brazilian Robotics Symposium (LARS/SBR).

[37]  Yangsheng Xu,et al.  Omni-directional steer-by-wire interface for four wheel independent steering vehicle , 2009, 2009 IEEE International Conference on Robotics and Automation.

[38]  Alin Albu-Schäffer,et al.  On the kinematic modeling and control of a mobile platform equipped with steering wheels and movable legs , 2009, 2009 IEEE International Conference on Robotics and Automation.

[39]  E. Snell-Rood,et al.  Interdisciplinarity: Bring biologists into biomimetics , 2016, Nature.

[40]  Andreas Müller,et al.  Kinematic analysis and singularity robust path control of a non-holonomic mobile platform with several steerable driving wheels , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[41]  Bernard Bayle,et al.  Manipulability of Wheeled Mobile Manipulators: Application to Motion Generation , 2003 .

[42]  Changbin Yu,et al.  Unit dual quaternion-based feedback linearization tracking problem for attitude and position dynamics , 2013, Syst. Control. Lett..

[43]  Nicolas Mansard,et al.  Optimization as motion selection principle in robot action , 2015, Commun. ACM.

[44]  Robin R. Murphy,et al.  How UGVs physically fail in the field , 2005, IEEE Transactions on Robotics.

[45]  William D. Smart,et al.  Robots for humanity: using assistive robotics to empower people with disabilities , 2013, IEEE Robotics & Automation Magazine.

[46]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

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

[48]  Han-Lin Li.  Solve least absolute value regression problems using modified goal programming techniques , 1998, Comput. Oper. Res..

[49]  Mariana de Paula Assis Fonseca,et al.  Whole-Body Modeling and Hierarchical Control of a Humanoid Robot Based on Dual Quaternion Algebra , 2016, 2016 XIII Latin American Robotics Symposium and IV Brazilian Robotics Symposium (LARS/SBR).

[50]  Siddhartha S. Srinivasa,et al.  Robots in the Home: Qualitative and Quantitative Insights into Kitchen Organization , 2015, 2015 10th ACM/IEEE International Conference on Human-Robot Interaction (HRI).

[51]  Antonio Bicchi,et al.  An atlas of physical human-robot interaction , 2008 .

[52]  David B. Reister,et al.  Position and constraint force control of a vehicle with two or more steerable drive wheels , 1993, IEEE Trans. Robotics Autom..

[53]  Oussama Khatib,et al.  A Unified Approach to Integrate Unilateral Constraints in the Stack of Tasks , 2009, IEEE Transactions on Robotics.

[54]  Jun-Ho Oh,et al.  Inverse Kinematic Control of Humanoids under Joint Constraints , 2013 .

[55]  Philippe Fraisse,et al.  The cross-motion invariant group and its application to kinematics , 2016, IMA J. Math. Control. Inf..

[56]  João Yoshiyuki Ishihara,et al.  Hybrid Kinematic Control for Rigid Body Pose Stabilization using Dual Quaternions , 2017, J. Frankl. Inst..

[57]  Oussama Khatib,et al.  Control of Free-Floating Humanoid Robots Through Task Prioritization , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[58]  Giuseppe Oriolo,et al.  Kinematic modeling and redundancy resolution for nonholonomic mobile manipulators , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[59]  Dmitry Berenson,et al.  Mobile Manipulation: Toward Smart Manufacturing [TC Spotlight] , 2015, IEEE Robotics & Automation Magazine.

[60]  M. Spong,et al.  Robot Modeling and Control , 2005 .

[61]  Ning Xi,et al.  Sensor-based redundancy resolution for a nonholonomic mobile manipulator , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[62]  Sandra Hirche,et al.  Constrained robot control using control barrier functions , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[63]  A. Liegeois,et al.  Automatic supervisory control of the configuration and behavior of multi-body mechanisms , 1977 .

[64]  Robert J. Vanderbei,et al.  Linear Programming: Foundations and Extensions , 1998, Kluwer international series in operations research and management service.

[65]  J. Michael McCarthy,et al.  Dual quaternion synthesis of constrained robotic systems , 2003 .

[66]  Bruno Siciliano,et al.  A solution algorithm to the inverse kinematic problem for redundant manipulators , 1988, IEEE J. Robotics Autom..

[67]  Yen-Lin Chen,et al.  Impact of Using an Educational Robot-Based Learning System on Students’ Motivation in Elementary Education , 2014, IEEE Transactions on Learning Technologies.

[68]  Bruno Vilhena Adorno,et al.  Whole-Body Control of a Mobile Manipulator Using Feedback Linearization Based on Dual Quaternions , 2016, 2016 XIII Latin American Robotics Symposium and IV Brazilian Robotics Symposium (LARS/SBR).

[69]  Y. Nakamura,et al.  Somatosensory computation for man-machine interface from motion-capture data and musculoskeletal human model , 2005, IEEE Transactions on Robotics.

[70]  Philippe Fraisse,et al.  Position and orientation control of robot manipulators using dual quaternion feedback , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[71]  O. Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[72]  Lydia E. Kavraki,et al.  Kinematically constrained workspace control via linear optimization , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[73]  Alain Micaelli,et al.  Modeling and feedback control of mobile robots equipped with several steering wheels , 1996, IEEE Trans. Robotics Autom..

[74]  Changbin Yu,et al.  A Dual Quaternion Solution to Attitude and Position Control for Rigid-Body Coordination , 2012, IEEE Transactions on Robotics.

[75]  Stefano Chiaverini,et al.  Singularity-robust task-priority redundancy resolution for real-time kinematic control of robot manipulators , 1997, IEEE Trans. Robotics Autom..