From 7d94b6c7866201397f0fb9ac418d47bb2ac3b2ad Mon Sep 17 00:00:00 2001 From: Unknown Date: Mon, 27 Jul 2020 18:20:14 -0400 Subject: [PATCH] Fix step_cb per @PAJohnson --- Firmware/MotorControl/axis.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/Firmware/MotorControl/axis.cpp b/Firmware/MotorControl/axis.cpp index bc11d1e4..375d75b8 100644 --- a/Firmware/MotorControl/axis.cpp +++ b/Firmware/MotorControl/axis.cpp @@ -118,8 +118,8 @@ bool Axis::wait_for_current_meas() { // step/direction interface void Axis::step_cb() { - const GPIO_PinState dir_pin = (GPIO_PinState)(dir_port_->IDR & dir_pin_); - const int32_t dir = (1 - 2 * (int32_t)dir_pin) * step_dir_active_; + const bool dir_pin = dir_port_->IDR & dir_pin_; + const int32_t dir = (-1 + 2 * dir_pin) * step_dir_active_; controller_.input_pos_ += dir * config_.counts_per_step; controller_.input_pos_updated(); };