Ensuring Viability: A QP-Based Inverse Kinematics for Handling Joint Range, Velocity and Acceleration Limits, as Well as Whole-body Collision Avoidance
##article.authors##
- 雅琛 張 広島大学 先進理工系科学研究科 機械力学研究室 https://orcid.org/0000-0003-4818-2563
-
亮 菊植
広島大学 先進理工系科学研究科 機械力学研究室
https://orcid.org/0000-0002-1500-6777
https://researchmap.jp/kikuuwe
DOI:
https://doi.org/10.51094/jxiv.1053Keywords:
Inverse kinematics, Collision avoidance, Quadratic programming, Mixed-integer linear programming, Viability kernelAbstract
This paper proposes a new quadratic programming (QP) based inverse kinematics (IK) method to simultaneously handle physical joint limits and whole-body collision avoidance, including self-collision and collisions with static obstacles.
These constraints may conflict with each other and result in infeasible solutions of IK, which can subsequently produce unpredictable motions.
The proposed method incorporates an additional linear constraint to ensure that the robot state is {\it viable}, guaranteeing the existence of solutions that do not violate the given constraints.
Our IK method consists of two stages: the offline construction stage and the online computation stage.
In the offline construction stage, the parameters of the proposed constraint for ensuring viable states are calculated.
In the online computation stage, the proposed constraints are updated in realtime based on the robot’s state, and the IK is solved as a QP problem.
The proposed method can effectively handle most robots with DOFs below 10 and can also accommodate some robots with higher DOFs under simpler constraints. This marks a significant advancement compared to previous studies.
The validity of the proposed method is illustrated through some simulation results.
Conflicts of Interest Disclosure
The authors have no conflicts of interest to declare that are relevant to the content of this article.Downloads *Displays the aggregated results up to the previous day.
References
Antonelli, G., Chiaverini, S., Fusco, G.: A new on-line algorithm for inverse kinematics of robot manipulators ensuring path tracking capability under joint limits. IEEE Transactions on Robotics and Automation 19(1), 162–167 (2003).
Flacco, F., De Luca, A., Khatib, O.: Control of redundant robots under hard joint constraints: Saturation in the null space. IEEE Transactions on Robotics 31(3), 637–654 (2015).
Guo, D., Zhang, Y.: Acceleration-level inequality-based MAN scheme for obstacle avoidance of redundant robot manipulators. IEEE Transactions on Industrial Electronics 61(12), 6903–6914 (2014).
Suleiman, W.: On inverse kinematics with inequality constraints: new insights into minimum jerk trajectory generation. Advanced Robotics 30(17-18), 1164–1172 (2016).
Quiroz-Omaña, J.J., Adorno, B.V.: Whole-body control with (self) collision avoidance using vector field inequalities. IEEE Robotics and Automation Letters 4(4), 4048–4053 (2019).
Park, K.C., Chang, P.H., Kim, S.H.: The enhanced compact QP method for redundant manipulators using practical inequality constraints. In: Proceedings of 1998 IEEE International Conference on Robotics and Automation, vol. 1, pp. 107–114 (1998).
Aubin, J.-P.: Viability Theory. Birkhäuser Boston, Boston, MA (2009).
Decré, W., Smits, R., Bruyninckx, H., De Schutter, J.: Extending iTaSC to support inequality constraints and non-instantaneous task specification. In: Proceedings of 2009 IEEE International Conference on Robotics and Automation, pp. 964–971 (2009).
Rubrecht, S., Padois, V., Bidaud, P., De Broissia, M.: Constraints compliant control: constraints compatibility and the displaced configuration approach. In: Proceedings of 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 677–684 (2010).
Del Prete, A.: Joint position and velocity bounds in discrete-time acceleration/torque control of robot manipulators. IEEE Robotics and Automation Letters 3(1), 281–288 (2017).
Saint-Pierre, P.: Approximation of the viability kernel. Applied Mathematics and Optimization 29, 187–209 (1994).
Rubrecht, S., Padois, V., Bidaud, P., De Broissia, M., Da Silva Simoes, M.: Motion safety and constraints compatibility for multibody robots. Autonomous Robots 32, 333–349 (2012).
Faroni, M., Beschi, M., Pedrocchi, N.: Inverse kinematics of redundant manipulators with dynamic bounds on joint movements. IEEE Robotics and Automation Letters 5(4), 6435–6442 (2020).
Nakamura, Y., Hanafusa, H.: Inverse kinematic solutions with singularity robustness for robot manipulator control. Transactions of ASME: Journal of Dynamic Systems, Measurement, and Control 108(3), 163–171 (1986).
Chiaverini, S.: Singularity-robust task-priority redundancy resolution for real-time kinematic control of robot manipulators. IEEE Transactions on Robotics and Automation 13(3), 398–410 (1997).
Dai, H., Amice, A., Werner, P., Zhang, A., Tedrake, R.: Certified polyhedral decompositions of collision-free configuration space. The International Journal of Robotics Research 43(9), 1322–1341 (2024).
Werner, P., Amice, A., Marcucci, T., Rus, D., Tedrake, R.: Approximating robot configuration spaces with few convex sets using clique covers of visibility graphs. In: Proceedings of 2024 IEEE International Conference on Robotics and Automation, pp. 10359–10365 (2024).
Bolusani, S., Besançon, M., Bestuzheva, K., Chmiela, A., Dionísio, J., Donkiewicz, T., Doornmalen, J., Eifler, L., Ghannam, M., Gleixner, A., Graczyk, C., Halbig, K., Hedtke, I., Hoen, A., Hojny, C., Hulst, R., Kamp, D., Koch, T., Kofler, K., Lentz, J., Manns, J., Mexi, G., Mühmer, E., Pfetsch, M.E., Schlösser, F., Serrano, F., Shinano, Y., Turner, M., Vigerske, S., Weninger, D., Xu, L.: The SCIP Optimization Suite 9.0. Technical report, Optimization Online (February 2024). [https://optimization-online.org/2024/02/the-scip-optimization-suite-9-0/](https://optimization-online.org/2024/02/the-scip-optimization-suite-9-0/).
GLPK (GNU Linear Programming Kit). [https://www.gnu.org/software/glpk](https://www.gnu.org/software/glpk).
Fukuda, K., Prodon, A.: Double description method revisited. In: Combinatorics and Computer Science, pp. 91–111. Springer, Berlin, Heidelberg (1996).
eigen-cddlib. [https://github.com/vsamy/eigen-cddlib](https://github.com/vsamy/eigen-cddlib).
Andersson, J.A.E., Gillis, J., Horn, G., Rawlings, J.B., Diehl, M.: CasADi – A software framework for nonlinear optimization and optimal control. Mathematical Programming Computation 11(1), 1–36 (2019). [https://doi.org/10.1007/s12532-018-0139-4](https://doi.org/10.1007/s12532-018-0139-4).
Stellato, B., Banjac, G., Goulart, P., Bemporad, A., Boyd, S.: OSQP: an operator splitting solver for quadratic programs. Mathematical Programming Computation.
Downloads
Posted
Submitted: 2025-01-22 07:43:20 UTC
Published: 2025-01-24 01:08:38 UTC
License
Copyright (c) 2025
雅琛 張
亮 菊植
This work is licensed under a Creative Commons Attribution-NonCommercial-NoDerivatives 4.0 International License.
