Added IsEnabled() to main loop. Completely ends the program when the robot is disabled via the driver station.