Fix some messages output
Finnaly got a correct serial reading. Well this is slow and i should find a solution for better performances