Making rosserial_python more robust