Finish refactring and test coverage for the original Roomba functionality