RobOptim Trajectory