self.prev_step_time = now
if self.dashboard_pub is not None:
start_dashboard_put = time.time()
self.dashboard_pub.put(OrderedDict({"display_stats": list(self.display_stats.items()), "should_stop": False}))
log.debug("dashboard put took %fs", time.time() - start_dashboard_put)
if self.is_stuck(obz): // TODO: derive this from collision, time elapsed, and distance as well
done = True