Update: more robust message control and reduced BAUD rate for x-bee to 9600 (better stability).