Improve Modbus RTU robustness. Fixes #126