Clean up code and move LED blinker to NORMALPRIO thread.