serial_write_str() can't send \0 bytes, don't use it.
Make the UART Rx FIFO larger, STK500 may need 257 bytes in extreme cases.