Bug fixes. Main problem was Arduino baud rate