diff --git a/src/axidraw_controller/src/py/axidraw_serial.py b/src/axidraw_controller/src/py/axidraw_serial.py index ffeda5b..b0b1210 100644 --- a/src/axidraw_controller/src/py/axidraw_serial.py +++ b/src/axidraw_controller/src/py/axidraw_serial.py @@ -68,6 +68,12 @@ class AxidrawSerial(Node): response.status = self.status.get(request.resource, "Resource '{}' not found.".format(request.resource)) return response + def go_home(self): + self.status["motion"] = "busy" + if self.status["serial"] == "ready": + self.ad.moveto(0,0) + self.status["motion"] = "ready" + def set_busy(self): self.status["motion"] = "busy" @@ -114,7 +120,7 @@ def main(args=None): axidraw_serial = AxidrawSerial() rclpy.spin(axidraw_serial) - + axidraw_serial.go_home() rclpy.shutdown()