GMR follows Sylvain Calinon implementation