Cleaned up code, played with RGB LED