From 0ce551be3014c3f6fcdbdeca0b19bbd5f574be33 Mon Sep 17 00:00:00 2001
From: Florian Rau <bimac@users.noreply.github.com>
Date: Wed, 9 Mar 2022 17:51:11 +0100
Subject: [PATCH] fix bug in positioning

---
 firmware/Bpod_stepper/StepperWrapper_TeensyStep.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/firmware/Bpod_stepper/StepperWrapper_TeensyStep.cpp b/firmware/Bpod_stepper/StepperWrapper_TeensyStep.cpp
index bdd3f8a..777bfbe 100644
--- a/firmware/Bpod_stepper/StepperWrapper_TeensyStep.cpp
+++ b/firmware/Bpod_stepper/StepperWrapper_TeensyStep.cpp
@@ -100,7 +100,7 @@ void StepperWrapper_TeensyStep::setPosition(int32_t pos) {
   noInterrupts();
   _microPosition = pos;
   interrupts();
-  _motor->setPosition(pos);
+  _motor->setPosition(0);
   writePosition(pos);
 }