From 9e189d1ef7046d7fa2526dce54c93b8b36684a8b Mon Sep 17 00:00:00 2001 From: Ryan howard Date: Fri, 12 Apr 2024 10:37:23 -0400 Subject: [PATCH] send message to both queues --- .../core/stepper_motor/motor_interrupt_handler.hpp | 3 +++ 1 file changed, 3 insertions(+) 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