Callback for Get_Error

Author: Your Name

src/ODriveCAN.cpp

@@ -192,6 +192,13 @@ void ODriveCAN::onReceive(uint32_t id, uint8_t length, const uint8_t* data) {
                 currents_callback_(iq, currents_user_data_);
             break;
         }
+        case Get_Error_msg_t::cmd_id: {
+            Get_Error_msg_t error;
+            error.decode_buf(data);
+            if (error_callback_)
+                error_callback_(error, error_user_data_);
+            break;
+        }
         default: {
             if (requested_msg_id_ == REQUEST_PENDING)
                 return;

src/ODriveCAN.h

@@ -247,6 +247,14 @@ class ODriveCAN {
         currents_user_data_ = user_data;
     }
 
+    /**
+     * @brief Registers a callback for ODrive error messages.
+     */
+    void onError(void (*callback)(Get_Error_msg_t& msg, void* user_data), void* user_data = nullptr) {
+        error_callback_ = callback;
+        error_user_data_ = user_data;
+    }
+
     /**
      * @brief Processes received CAN messages for the ODrive.
      */
@@ -360,11 +368,13 @@ class ODriveCAN {
     void* temperature_user_data_;
     void* busVI_user_data_;
     void* currents_user_data_;
+    void* error_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;
     void (*busVI_callback_)(Get_Bus_Voltage_Current_msg_t& feedback, void* user_data) = nullptr;
     void (*currents_callback_)(Get_Iq_msg_t& feedback, void* user_data) = nullptr;
+    void (*error_callback_)(Get_Error_msg_t& msg, void* user_data) = nullptr;
 };