cli: Fixed invalid argument debug print
trajectory_manager: trajectory_next_point available to user