diff --git a/turret.cpp b/turret.cpp index fde2d4e..fc570ed 100644 --- a/turret.cpp +++ b/turret.cpp @@ -1,4 +1,5 @@ #include "turret.h" +#include "Arduino.h" #include "maths.h" #include @@ -17,6 +18,15 @@ Turret::Turret(StepRatio step_ratio, Offset offset, PinMap pin_map_x, _offset = offset; } +Turret::~Turret() { + _stepper.x.stop(); + _stepper.x.disable(); + _stepper.y.stop(); + _stepper.y.disable(); + digitalWrite(_pin.x.laser, LOW); + digitalWrite(_pin.y.laser, LOW); +} + Turret &Turret::init() { pinMode(_pin.x.laser, OUTPUT); pinMode(_pin.y.laser, OUTPUT); diff --git a/turret.h b/turret.h index 07de1fc..e5cefb5 100644 --- a/turret.h +++ b/turret.h @@ -40,6 +40,7 @@ public: Turret(StepRatio step_ratio, Offset offset, PinMap pin_map_x, PinMap pin_map_y); + ~Turret(); Turret &init(); Turret &gotoHome();