Add test coverage and continued refactoring of Roomba driver
Finish refactring and test coverage for the original Roomba functionality