#include "robot_state.h"

RobotState robot = {
  MODE_IDLE,
  0,
  150,
  150
};

const char* modeToStr(RobotMode m) {
  switch (m) {
    case MODE_IDLE: return "IDLE";
    case MODE_MANUAL: return "MANUAL";
    case MODE_AUTO: return "AUTO";
    case MODE_SERVICE: return "SERVICE";
    default: return "?";
  }
}