Reorganized code for serial interface. again, untested on roomba