Continued the debugging of the controller class. Trying to make sure that the RobotState class is initialized before it is used