Learning Riemannian Manifolds for Geodesic Motion Skills

*For robots to work alongside humans and perform in unstructured environments, they must learn new motion skills and adapt them to unseen situations on the fly. This demands learning models that capture relevant motion patterns, while offering enough flexibility to adapt the encoded skills to new requirements, such as dynamic obstacle avoidance. We introduce a Riemannian manifold perspective on this problem, and propose to learn a Riemannian manifold from human demonstrations on which geodesics are natural motion skills. We realize this with a variational autoencoder (VAE) over the space of position and orientations of the robot end-effector. Geodesic motion skills let a robot plan movements from and to arbitrary points on the data manifold. They also provide a straightforward method to avoid obstacles by redefining the ambient metric in an online fashion. Moreover, geodesics naturally exploit the manifold resulting from multiple–mode tasks to design motions that were not explicitly demonstrated previously. We test our learning framework using a 7-DoF robotic manipulator, where the robot satisfactorily learns and reproduces realistic skills featuring elaborated motion patterns, avoids previously–unseen obstacles, and generates novel movements in multiple-mode settings.

[1]  M. G. Mohanan,et al.  A survey of robotic motion planning in dynamic environments , 2018, Robotics Auton. Syst..

[2]  Emre Ugur,et al.  Conditional Neural Movement Primitives , 2019, Robotics: Science and Systems.

[3]  Søren Hauberg,et al.  Variational Autoencoders with Riemannian Brownian Motion Priors , 2020, ICML.

[4]  S. Schaal Dynamic Movement Primitives -A Framework for Motor Control in Humans and Humanoid Robotics , 2006 .

[5]  Soren Hauberg,et al.  Expected path length on random manifolds , 2019, ArXiv.

[6]  Xin-She Yang,et al.  Introduction to Algorithms , 2021, Nature-Inspired Optimization Algorithms.

[7]  Siddhartha S. Srinivasa,et al.  CHOMP: Gradient optimization techniques for efficient motion planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

[8]  Subramanian Ramamoorthy,et al.  Motion planning and reactive control on learnt skill manifolds † , 2013, Int. J. Robotics Res..

[9]  Suvrit Sra,et al.  Directional Statistics in Machine Learning: a Brief Review , 2016, 1605.00316.

[10]  Natalia Gimelshein,et al.  PyTorch: An Imperative Style, High-Performance Deep Learning Library , 2019, NeurIPS.

[11]  Søren Hauberg,et al.  Scalable Robust Principal Component Analysis Using Grassmann Averages , 2016, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[12]  Carme Torras,et al.  Robot learning from demonstration of force-based tasks with multiple solution trajectories , 2011, 2011 15th International Conference on Advanced Robotics (ICAR).

[13]  Max Welling,et al.  Auto-Encoding Variational Bayes , 2013, ICLR.

[14]  Abhinav Gupta,et al.  Neural Dynamic Policies for End-to-End Sensorimotor Learning , 2020, NeurIPS.

[15]  Darwin G. Caldwell,et al.  Kernelized movement primitives , 2017, Int. J. Robotics Res..

[16]  Scott Kuindersma,et al.  Robot learning from demonstration by constructing skill trees , 2012, Int. J. Robotics Res..

[17]  Themistocles M. Rassias,et al.  Introduction to Riemannian Manifolds , 2001 .

[18]  Serge J. Belongie,et al.  Non-isometric manifold learning: analysis and an algorithm , 2007, ICML '07.

[19]  Pieter Abbeel,et al.  An Algorithmic Perspective on Imitation Learning , 2018, Found. Trends Robotics.

[20]  Meng Guo,et al.  Learning and Sequencing of Object-Centric Manipulation Skills for Industrial Tasks , 2020, 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[21]  Aude Billard,et al.  Learning task manifolds for constrained object manipulation , 2018, Auton. Robots.

[22]  Lars Kai Hansen,et al.  Latent Space Oddity: on the Curvature of Deep Generative Models , 2017, ICLR.

[23]  Jan Peters,et al.  Learning multiple collaborative tasks with a mixture of Interaction Primitives , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[24]  Xueyan Jiang,et al.  Metrics for Deep Generative Models , 2017, AISTATS.

[25]  Sylvain Calinon,et al.  A tutorial on task-parameterized movement learning and retrieval , 2015, Intelligent Service Robotics.

[26]  Jun Nakanishi,et al.  Dynamical Movement Primitives: Learning Attractor Models for Motor Behaviors , 2013, Neural Computation.

[27]  Sylvain Calinon,et al.  Bayesian Optimization Meets Riemannian Manifolds in Robot Learning , 2019, CoRL.

[28]  P. Thomas Fletcher,et al.  The Riemannian Geometry of Deep Generative Models , 2017, 2018 IEEE/CVF Conference on Computer Vision and Pattern Recognition Workshops (CVPRW).

[29]  Justin Bayer,et al.  Fast Approximate Geodesics for Deep Generative Models , 2018, ICANN.

[30]  Bernhard Schölkopf,et al.  Geometrically Enriched Latent Spaces , 2020, AISTATS.

[31]  Oliver M. O’Reilly,et al.  Perspectives on Euler angle singularities, gimbal lock, and the orthogonality of applied forces and applied moments , 2018 .

[32]  Arthur Richards,et al.  Trajectory Optimisation in Learned Multimodal Dynamical Systems via Latent-ODE Collocation , 2021, 2021 IEEE International Conference on Robotics and Automation (ICRA).

[33]  Milan Simic,et al.  Sampling-Based Robot Motion Planning: A Review , 2014, IEEE Access.

[34]  Jan Peters,et al.  Using probabilistic movement primitives in robotics , 2017, Autonomous Robots.

[35]  Søren Hauberg,et al.  Fast and Robust Shortest Paths on Manifolds Learned from Data , 2019, AISTATS.

[36]  Ricardo Campa,et al.  Unit Quaternions: A Mathematical Tool for Modeling, Path Planning and Control of Robot Manipulators , 2008 .

[37]  Christopher K. I. Williams,et al.  Magnification factors for the SOM and GTM algorithms , 1997 .

[38]  Søren Hauberg,et al.  Only Bayes should learn a manifold , 2019 .

[39]  Sonia Chernova,et al.  Recent Advances in Robot Learning from Demonstration , 2020, Annu. Rev. Control. Robotics Auton. Syst..

[40]  Saif Sidhik panda_simulator: Gazebo simulator for Franka Emika Panda robot supporting sim-to-real code transfer , 2020 .