Finish implementation of jogging_command_controller.  No compilation testing yet.