Added IsEnabled() to main loop. Completely ends the program when the rob...

...ot is disabled via the driver station.