Callback for Get_Temperature

Author: Your Name

src/ODriveCAN.cpp

@@ -171,6 +171,13 @@ void ODriveCAN::onReceive(uint32_t id, uint8_t length, const uint8_t* data) {
                 Serial.println(F("missing callback"));
             break;
         }
+        case Get_Temperature_msg_t::cmd_id: {
+            Get_Temperature_msg_t temperature;
+            temperature.decode_buf(data);
+            if (temperature_callback_)
+                temperature_callback_(temperature, temperature_user_data_);
+            break;
+        }
         default: {
             if (requested_msg_id_ == REQUEST_PENDING)
                 return;

src/ODriveCAN.h

@@ -222,6 +222,14 @@ class ODriveCAN {
         torques_user_data_ = user_data;
     }
 
+    /**
+     * @brief Registers a callback for ODrive temperature feedback.
+     */
+    void onTemperature(void (*callback)(Get_Temperature_msg_t& feedback, void* user_data), void* user_data = nullptr) {
+        temperature_callback_ = callback;
+        temperature_user_data_ = user_data;
+    }
+
     /**
      * @brief Processes received CAN messages for the ODrive.
      */
@@ -332,8 +340,10 @@ class ODriveCAN {
     void* axis_state_user_data_;
     void* feedback_user_data_;
     void* torques_user_data_;
+    void* temperature_user_data_;
 
     void (*axis_state_callback_)(Heartbeat_msg_t& feedback, void* user_data) = nullptr;
     void (*feedback_callback_)(Get_Encoder_Estimates_msg_t& feedback, void* user_data) = nullptr;
     void (*torques_callback_)(Get_Torques_msg_t& feedback, void* user_data) = nullptr;
+    void (*temperature_callback_)(Get_Temperature_msg_t& feedback, void* user_data) = nullptr;
 };