fix Committing GeometricPlanningSE3 #3