First test on Firmware

/ This release of the FW tests the leds
Test FW corrected

/ Corrected GPIO configuration to drive RGB LEds