quick bug fixes
Tested iRobot drive