Fixed LEDs

Initialized output pins and cleaned up code slightly