Added command message loop
Added calibration LED control