Added RobotState and played with autonomous