diff --git a/include/motor-control/core/stepper_motor/motor_interrupt_handler.hpp b/include/motor-control/core/stepper_motor/motor_interrupt_handler.hpp index 336d6a608..7644f1cc0 100644 --- a/include/motor-control/core/stepper_motor/motor_interrupt_handler.hpp +++ b/include/motor-control/core/stepper_motor/motor_interrupt_handler.hpp @@ -650,8 +650,11 @@ class MotorInterruptHandler { #ifdef USE_PRESSURE_MOVE void send_to_pressure_sensor_queue( can::messages::BindSensorOutputRequest& m) { + // send to both queues, they will handle their own gating based on sensor id std::ignore = sensor_tasks::get_queues() .pressure_sensor_queue_rear->try_write_isr(m); + std::ignore = sensor_tasks::get_queues() + .pressure_sensor_queue_front->try_write_isr(m); // if (!success) {this->cancel_and_clear_moves();} } #endif