UART send works now, danke Matthias
Added debug msgs.