[Pacrg] Geometric January - Riemannian Motion Policies