def _update(self, update):
# Handle EStop
- if update.get('xx', '') == 'ESTOPPED': self.planner.reset()
+ if update.get('xx', '') == 'ESTOPPED': self.planner.reset(False)
# Detect motor faults
for motor in range(4):
ctrl.state.add_listener(self._update)
- self.reset()
+ self.reset(False)
self._report_time()
self.current_plan_time = 0
- def reset(self):
- if hasattr(self.ctrl, 'mach'): self.ctrl.mach.stop()
+ def reset(self, stop = True):
+ if stop: self.ctrl.mach.stop()
self.planner = gplan.Planner()
self.planner.set_resolver(self._get_var_cb)
self.planner.set_logger(self._log_cb, 1, 'LinePlanner:3')