Abstract
This paper introduces a local motion planning method for robotic systems with manipulating limbs, moving bases (legged or wheeled), and stance stability constraints arising from the presence of gravity. We formulate the problem of selecting local motions as a linearly constrained quadratic program (QP), that can be solved efficiently. The solution to this QP is a tuple of locally optimal joint velocities. By using these velocities to step towards a goal, both a path and an inverse-kinematic solution to the goal are obtained. This formulation can be used directly for real-time control, or as a local motion planner to connect waypoints. This method is particularly useful for high-degree-of-freedom mobile robotic systems, as the QP solution scales well with the number of joints. We also show how a number of practically important geometric constraints (collision avoidance, mechanism self-collision avoidance, gaze direction, etc.) can be readily incorporated into either the constraint or objective parts of the formulation. Additionally, motion of the base, a particular joint, or a particular link can be encouraged/discouraged as desired. We summarize the important kinematic variables of the formulation, including the stance Jacobian, the reach Jacobian, and a center of mass Jacobian. The method is easily extended to provide sparse solutions, where the fewest number of joints are moved, by iteration using Tibshirani’s method to accommodate an \(l_1\) regularizer. The approach is validated and demonstrated on SURROGATE, a mobile robot with a TALON base, a 7 DOF serial-revolute torso, and two 7 DOF modular arms developed at JPL/Caltech.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
Notes
- 1.
Refer to [16], Chap. 5 for background.
- 2.
These kinematics are well known, and arise from writing the no-slip conditions for each wheel with respect to the base frame.
- 3.
A desired velocity for the end-effector can be determined from the transformation between the current pose and the desired pose; the velocity (twist) corresponding to the error is determined by the matrix logarithm. See [16] Chap. 2.
- 4.
This is the coefficient matrix one obtains when the KKT conditions for this problem posed as a QP in standard form are written as a linear equation in primal and dual variables. See [17] for background.
- 5.
The worst case complexity of solving a QP with linear constraints is shown to be \(O(n^3 L)\) where \(n\) is the size of the decision variable, and \(L\) is the program input size [18].
References
Siciliano, B.: Kinematic control of redundant robot manipulators: a tutorial. J. Intell. Robot. Syst. 3, 201–212 (1990)
Nakamura, Y., Hanafusa, H., Yoshikawa, T.: Task-priority based redundancy control of robot manipulators. Int. J. Robot. Res. 6(2), 2–15 (1987)
Buss, S.R.: Introduction to inverse kinematics with jacobian transpose, pseudoinverse and damped least squares methods
Bertram, D., Kuffner, J., Dillmann, R., et al.: An integrated approach to inverse kinematics and path planning for redundant manipulators. In: Proceedings of the IEEE International Conference on Robotics and Automation, pp. 1874–1879 (2006)
Satzinger, B.W., Reid, J.I., Bajracharya, M., et al.: More solutions means more problems: resolving kinematic redundancy in robot locomotion on complex terrain
Yamamoto, Y., Yun, X.: Coordinating locomotion and manipulation of a mobile manipulator. In: Proceedings of the 31st IEEE Conference on Decision and Control, pp. 2643–2648 (1992)
Brock, O., Khatib, O., Viji, S.: Task-consistent obstacle avoidance and motion behavior for mobile manipulation. In: Proceedings of the IEEE International Conference Robotics and Automation, pp. 388–393 (2002)
Harada, K., Kajita, S., Kanehiro, F., et al.: Real-time planning of humanoid robot’s gait for force-controlled manipulation. IEEE/ASME Trans. Mech. 12(1), 53–62 (2007)
Zhang, Y., Ge, S., Lee, T.: A unified quadratic-programming-based dynamical system approach to joint torque optimizaiton of physically constrained redundant manipulators. IEEE Trans. Syst. Man, Cybern. Part B: Cybern. 34(5), 2126–2132 (2004)
Zhang, Y., Zhang, Z.: Repetitive Motion Planning and Control of Redundant Robot Manipulators. Springer (2013)
Kanehiro, F., Lamiraux, F., Kanoun, O., et al.: A local collision avoidance method for non-strictly convex polyhedra. In: Proceedings of the Robotics: Science and Systems IV (2008)
Schulman, J., Duan, Y., Ho, J., et al.: Motion planning with sequential convex optimization and convex collision checking. Int. J. Robot. Res. (2014) (0278364914528132)
Shankar, K., Burdick, J.W.: Kinematics and methods for combined quasi-static stance/reach planning in multi-limbed robots. In: Proceedings of the IEEE International Conference on Robotics and Automation (2014)
Fallon, M., Kuindersma, S., Karumanchi, S., et al.: An architecture for online affordance-based perception and whole-body planning. Technical Report MIT-CSAIL-TR-2014-003, CSAIL, MIT, Boston, MA, March 2014
Kuindersma, S., Permenter, F., Tedrake, R.: An efficiently solvable quadratic program for stabilizing dynamic locomotion. arXiv preprint arXiv:1311.1839 (2013)
Murray, R.M., Li, Z., Sastry, S.S.: A Mathematical Introduction to Robotic Manipulation. CRC Press (1994)
Boyd, S.P., Vandenberghe, L.: Convex Optimization. Cambridge University Press (2004)
Goldfarb, D., Liu, S.: An o (n 3 l) primal interior point algorithm for convex quadratic programming. Math. Progr. 49(1–3), 325–340 (1990)
Maciejewski, A.A., Klein, C.A.: Obstacle avoidance for kinematically redundant manipulators in dynamically varying environments. Int. J. Robot. Res. 4(3), 109–117 (1985)
Tibshirani, R.: Regression shrinkage and selection via the Lasso. J. R. Stat. Soc. Series B (Methodological) 267–288 (1996)
Mattingley, J., Boyd, S.: CVXGEN: a code generator for embedded convex optimization. Optim. Eng. 13(1), 1–27 (2012)
Courmans, E.: Bullet physics engine. http://bulletphysics.org/Bullet/BulletFull/
Hudson, N., Ma, J., Hebert, P., et al.: Model-based autonomous system for performing dexterous, human-level manipulation tasks. Auton. Robot. 36(1–2), 31–49 (2014)
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2015 Springer International Publishing Switzerland
About this chapter
Cite this chapter
Shankar, K., Burdick, J.W., Hudson, N.H. (2015). A Quadratic Programming Approach to Quasi-Static Whole-Body Manipulation. In: Akin, H., Amato, N., Isler, V., van der Stappen, A. (eds) Algorithmic Foundations of Robotics XI. Springer Tracts in Advanced Robotics, vol 107. Springer, Cham. https://doi.org/10.1007/978-3-319-16595-0_32
Download citation
DOI: https://doi.org/10.1007/978-3-319-16595-0_32
Published:
Publisher Name: Springer, Cham
Print ISBN: 978-3-319-16594-3
Online ISBN: 978-3-319-16595-0
eBook Packages: EngineeringEngineering (R0)