Added more waypoint control and different command/behaviors for ArduRover