util function
robot control uses Roomba class
roomba control has been separated from particle filter