Skip to main content
Log in

An analysis of RelaxedIK: an optimization-based framework for generating accurate and feasible robot arm motions

  • Published:
Autonomous Robots Aims and scope Submit manuscript

Abstract

We present a real-time motion-synthesis method for robot manipulators, called RelaxedIK, that is able to not only accurately match end-effector pose goals as done by traditional IK solvers, but also create smooth, feasible motions that avoid joint-space discontinuities, self-collisions, and kinematic singularities. To achieve these objectives on-the-fly, we cast the standard IK formulation as a weighted-sum non-linear optimization problem, such that motion goals in addition to end-effector pose matching can be encoded as terms in the sum. We present a normalization procedure such that our method is able to effectively make trade-offs to simultaneously reconcile many, and potentially competing, objectives. Using these trade-offs, our formulation allows features to be relaxed when in conflict with other features deemed more important at a given time. We compare performance against a state-of-the-art IK solver and a real-time motion-planning approach in several geometric and real-world tasks on seven robot platforms ranging from 5-DOF to 8-DOF. We show that our method achieves motions that effectively follow position and orientation end-effector goals without sacrificing motion feasibility, resulting in more successful execution of tasks compared to the baseline approaches. We also empirically evaluate how our solver performs with different optimization solvers, gradient calculation methods, and choice of loss function in the objective function.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Institutional subscriptions

Fig. 1
Fig. 2
Fig. 3
Fig. 4
Fig. 5

Similar content being viewed by others

Notes

  1. http://moveit.ros.org/.

  2. http://www.fanuc.eu/se/en/robots/robot-filter-page/lrmate-series.

  3. https://www.universal-robots.com/products/ur5-robot/.

  4. http://www.kinovarobotics.com/innovation-robotics/products/robot-arms/.

  5. http://www.rethinkrobotics.com/sawyer/.

  6. https://www.kuka.com/en-us/products/robotics-systems/lbr-iiwa.

  7. http://www.rainbow-robotics.com/products_humanoid.

  8. NLopt: https://nlopt.readthedocs.io/en/latest/.

  9. https://github.com/JuliaMath/Calculus.jl.

References

  • Aristidou, A., Lasenby, J., Chrysanthou, Y., & Shamir, A. (2018). Inverse kinematics techniques in computer graphics: A survey. In Computer graphics forum, Wiley Online Library (Vol. 37, pp. 35–58).

  • Baerlocher, P., & Boulic, R. (2004). An inverse kinematics architecture enforcing an arbitrary number of strict priority levels. The Visual Computer, 20(6), 402–417.

    Article  Google Scholar 

  • Beeson, P., & Ames, B. (2015). TRAC-IK: An open-source library for improved solving of generic inverse kinematics. In 2015 IEEE-RAS 15th international conference on humanoid robots (humanoids) (pp. 928–935). IEEE.

  • Bialkowski, .J, Karaman, S., & Frazzoli, E. (2011). Massively parallelizing the RRT and the RRT. In 2011 IEEE/RSJ international conference on intelligent robots and systems (IROS) (pp. 3513–3518). IEEE.

  • Cefalo, M., Oriolo, G., & Vendittelli, M. (2013). Planning safe cyclic motions under repetitive task constraints. In 2013 IEEE international conference on robotics and automation (pp. 3807–3812). IEEE.

  • Chiacchio, P., Chiaverini, S., Sciavicco, L., & Siciliano, B. (1991). Closed-loop inverse kinematics schemes for constrained redundant manipulators with task space augmentation and task priority strategy. The International Journal of Robotics Research, 10(4), 410–425.

    Article  Google Scholar 

  • Chiaverini, S. (1997). Singularity-robust task-priority redundancy resolution for real-time kinematic control of robot manipulators. IEEE Transactions on Robotics and Automation, 13(3), 398–410.

    Article  Google Scholar 

  • Diankov, R. (2010). Automated construction of robotic manipulation programs. PhD thesis, Carnegie Mellon University, Robotics Institute. Retrieved January 15, 2018, from http://www.programmingvision.com/rosen_diankov_thesis.pdf.

  • Flash, T., & Hogan, N. (1985). The coordination of arm movements: An experimentally confirmed mathematical model. Journal of Neuroscience, 5(7), 1688–1703.

    Article  Google Scholar 

  • Gosselin, C., & Angeles, J. (1990). Singularity analysis of closed-loop kinematic chains. IEEE Transactions on Robotics and Automation, 6(3), 281–290.

    Article  Google Scholar 

  • Hauser, K. (2012). On responsiveness, safety, and completeness in real-time motion planning. Autonomous Robots, 32(1), 35–48.

    Article  Google Scholar 

  • Hauser, K. (2016). Continuous pseudoinversion of a multivariate function: Application to global redundancy resolution. In 12th International workshop on the algorithmic foundations of robotics.

  • Kalakrishnan, M., Chitta, S., Theodorou, E., Pastor, P., & Schaal, S. (2011). STOMP: Stochastic trajectory optimization for motion planning. In 2011 IEEE international conference on robotics and automation (ICRA) (pp. 4569–4574). IEEE.

  • Kavraki, L. E., Svestka, P., Latombe, J. C., & Overmars, M. H. (1996). Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE Transactions on Robotics and Automation, 12(4), 566–580.

    Article  Google Scholar 

  • Khatib, O. (1986). Real-time obstacle avoidance for manipulators and mobile robots. The International Journal of Robotics Research, 5(1), 90–98.

    Article  Google Scholar 

  • Kraft, D. (1988). A software package for sequential quadratic programming. Forschungsbericht- Deutsche Forschungs- und Versuchsanstalt fur Luft- und Raumfahrt.

  • Kuffner, J. J., & LaValle, S. M. (2000). RRT-connect: An efficient approach to single-query path planning. In 2000 IEEE international conference on robotics and automation (ICRA) (Vol. 2, pp. 995–1001). IEEE.

  • Lee, J. (2008). Representing rotations and orientations in geometric computing. IEEE Computer Graphics and Applications, 28(2), 75–83.

    Article  Google Scholar 

  • Maciejewski, A. A. (1990). Dealing with the ill-conditioned equations of motion for articulated figures. IEEE Computer Graphics and Applications, 10(3), 63–71.

    Article  Google Scholar 

  • Mansard, N., Khatib, O., & Kheddar, A. (2009a). A unified approach to integrate unilateral constraints in the stack of tasks. IEEE Transactions on Robotics, 25(3), 670–685.

    Article  Google Scholar 

  • Mansard, N., Stasse, O., Evrard, P., & Kheddar, A. (2009b). A versatile generalized inverted kinematics implementation for collaborative working humanoid robots: The stack of tasks. In 2009 International conference on advanced robotics (pp. 1–6). IEEE.

  • Murray, S., Floyd-Jones, W., Qi, Y., Sorin, D. J., & Konidaris, G. (2016). Robot motion planning on a chip. In Robotics: Science and systems.

  • Nakamura, Y. (1990). Advanced robotics: Redundancy and optimization. Boston: Addison-Wesley Longman Publishing Co., Inc.

    Google Scholar 

  • Oriolo, G., & Mongillo, C. (2005). Motion planning for mobile manipulators along given end-effector paths. In Proceedings of the 2005 IEEE international conference on robotics and automation (pp. 2154–2160). IEEE.

  • Oriolo, G., & Vendittelli, M. (2009). A control-based approach to task-constrained motion planning. In 2009 IEEE/RSJ international conference on intelligent robots and systems (pp. 297–302). IEEE.

  • Powell, M. J. (1994). A direct search optimization method that models the objective and constraint functions by linear interpolation. In Advances in optimization and numerical analysis (pp. 51–67). Springer.

  • Powell, M. J. (2009). The BOBYQA algorithm for bound constrained optimization without derivatives. Cambridge NA Report NA2009/06, University of Cambridge, Cambridge, pp. 26–46.

  • Praveena, P., Rakita, D., Mutlu, B., & Gleicher, M. (2019). User-guided offline synthesis of robot arm motion from 6-dof paths. In IEEE international conference on robotics and automation (ICRA). IEEE.

  • Rakita, D., Mutlu, B., & Gleicher, M. (2017). A motion retargeting method for effective mimicry-based teleoperation of robot arms. InProceedings of the 2017 ACM/IEEE international conference on human–robot interaction (pp. 361–370). ACM.

  • Rakita, D., Mutlu, B., & Gleicher, M. (2018a). An autonomous dynamic camera method for effective remote teleoperation. In Proceedings of the 2018 ACM/IEEE international conference on human–robot interaction. ACM.

  • Rakita, D., Mutlu, B., & Gleicher, M. (2018b). RelaxedIK: Real-time synthesis of accurate and feasible robot arm motion. In Proceedings of robotics: Science and systems, Pittsburgh, Pennsylvania. https://doi.org/10.15607/RSS.2018.XIV.043.

  • Rakita, D., Mutlu, B., Gleicher, M., & Hiatt, L. M. (2018c). Shared dynamic curves: A shared-control telemanipulation method for motor task training. In Proceedings of the 2018 ACM/IEEE international conference on human–robot interaction. ACM.

  • Rakita, D., Mutlu, B., & Gleicher, M. (2019a). Remote telemanipulation with adapting viewpoints in visually complex environments. In Proceedings of robotics: Science and systems, FreiburgimBreisgau, Germany. https://doi.org/10.15607/RSS.2019.XV.068.

  • Rakita, D., Mutlu, B., & Gleicher, M. (2019b). Stampede: A discrete-optimization method for solving pathwise-inverse kinematics. In IEEE international conference on robotics and automation (ICRA). IEEE.

  • Rakita, D., Mutlu, B., Gleicher, M., & Hiatt, L. M. (2019c). Shared control-based bimanual robot manipulation. Science Robotics, 4(30), eaaw0955.

    Article  Google Scholar 

  • Ratliff, N., Zucker, M., Bagnell, J. A., & Srinivasa, S. (2009). CHOMP: Gradient optimization techniques for efficient motion planning. In 2009 IEEE international conference on robotics and automation (ICRA) (pp. 489–494). IEEE.

  • Revels, J., Lubin, M., & Papamarkou, T. (2016). Forward-mode automatic differentiation in Julia. arXiv:1607.07892 [csMS].

  • Schulman, J., Duan, Y., Ho, J., Lee, A., Awwal, I., Bradlow, H., et al. (2014). Motion planning with sequential convex optimization and convex collision checking. The International Journal of Robotics Research, 33(9), 1251–1270.

    Article  Google Scholar 

  • Sentis, L., & Khatib, O. (2005). Synthesis of whole-body behaviors through hierarchical control of behavioral primitives. International Journal of Humanoid Robotics, 2(04), 505–518.

    Article  Google Scholar 

  • Shin, H. J., Lee, J., Shin, S. Y., & Gleicher, M. (2001). Computer puppetry: An importance-based approach. ACM Transactions on Graphics (TOG), 20(2), 67–94.

    Article  Google Scholar 

  • Siciliano, B. (1990). Kinematic control of redundant robot manipulators: A tutorial. Journal of Intelligent & Robotic Systems, 3(3), 201–212.

    Article  Google Scholar 

  • Sina Mirrazavi Salehian, S., Figueroa, N., & Billard, A. (2016). Coordinated multi-arm motion planning: Reaching for moving objects in the face of uncertainty. In Proceedings of robotics: Science and systems.

  • Sucan, I. A., Moll, M., & Kavraki, L. E. (2012). The open motion planning library. IEEE Robotics & Automation Magazine, 19(4), 72–82.

    Article  Google Scholar 

  • Svanberg, K. (2002). A class of globally convergent optimization methods based on conservative convex separable approximations. SIAM Journal on Optimization, 12(2), 555–573.

    Article  MathSciNet  Google Scholar 

  • Yoshikawa, T. (1985). Manipulability of robotic mechanisms. The International Journal of Robotics Research, 4(2), 3–9.

    Article  MathSciNet  Google Scholar 

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Daniel Rakita.

Additional information

Publisher's Note

Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.

This research was supported by the National Science Foundation under Award 1208632 and the University of Wisconsin–Madison Office of the Vice Chancellor for Research and Graduate Education with funding from the Wisconsin Alumni Research Foundation.

This is one of the several papers published in Autonomous Robots comprising the Special Issue on Robotics: Science and Systems.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Rakita, D., Mutlu, B. & Gleicher, M. An analysis of RelaxedIK: an optimization-based framework for generating accurate and feasible robot arm motions. Auton Robot 44, 1341–1358 (2020). https://doi.org/10.1007/s10514-020-09918-9

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s10514-020-09918-9

Keywords

Navigation