Made robot mode init in constructor instead because initializing should be
after wpi.