Fixing led blink, adding printf support