Started to implement the DriverStation wpilib class in order to be able to use different modes