From d272fbe2b4d4a6a87acf75f344db7a098c29179e Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Torbj=C3=B8rn=20Ludvigsen?= <tobben@fastmail.fm>
Date: Tue, 29 Mar 2022 22:31:12 +0200
Subject: [PATCH] Puts fmodf_pos back into the steps_ assignment

---
 Firmware/MotorControl/controller.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/Firmware/MotorControl/controller.cpp b/Firmware/MotorControl/controller.cpp
index cbedb140..ab7e62eb 100644
--- a/Firmware/MotorControl/controller.cpp
+++ b/Firmware/MotorControl/controller.cpp
@@ -90,7 +90,7 @@ bool Controller::anticogging_calibration(float pos_estimate, float vel_estimate)
 void Controller::set_input_pos_and_steps(float const pos) {
     input_pos_ = pos;
     float const range = config_.circular_setpoint_range;
-    axis_->steps_ = (int64_t)(wrap_pm(pos, range) / range * config_.steps_per_circular_range);
+    axis_->steps_ = (int64_t)(fmodf_pos(pos, range) / range * config_.steps_per_circular_range);
 }
 
 void Controller::update_filter_gains() {