Added controller battery check
Rewrote led_blink