master/fsm_soe.c
changeset 1877 7b77000f9764
parent 1873 219be3742274
child 1881 f0047c6226c0
--- a/master/fsm_soe.c	Fri Mar 19 11:07:49 2010 +0100
+++ b/master/fsm_soe.c	Fri Mar 19 12:01:32 2010 +0100
@@ -74,6 +74,29 @@
 
 /*****************************************************************************/
 
+extern const ec_code_msg_t soe_error_codes[];
+
+/*****************************************************************************/
+
+/** Outputs an SoE error code.
+*/
+void ec_print_soe_error(uint16_t error_code)
+{
+    const ec_code_msg_t *error_msg;
+
+    for (error_msg = soe_error_codes; error_msg->code; error_msg++) {
+        if (error_msg->code == error_code) {
+            EC_ERR("SoE error 0x%04X: \"%s\".\n",
+                   error_msg->code, error_msg->message);
+            return;
+        }
+    }
+
+    EC_ERR("Unknown SoE error 0x%04X.\n", error_code);
+}
+
+/*****************************************************************************/
+
 /** Constructor.
  */
 void ec_fsm_soe_init(
@@ -353,8 +376,8 @@
 
     if (error_flag) {
         req->error_code = EC_READ_U16(data + rec_size - 2);
-        EC_ERR("Received error response: 0x%04x.\n",
-                req->error_code);
+        EC_ERR("Received error response:\n");
+        ec_print_soe_error(req->error_code);
         fsm->state = ec_fsm_soe_error;
         return;
     } else {
@@ -658,8 +681,8 @@
                     " but received size is %zu.\n", rec_size);
         } else {
             req->error_code = EC_READ_U16(data + EC_SOE_WRITE_RESPONSE_SIZE);
-            EC_ERR("Received error response: 0x%04x.\n",
-                    req->error_code);
+            EC_ERR("Received error response:\n");
+            ec_print_soe_error(req->error_code);
         }
         ec_print_data(data, rec_size);
         fsm->state = ec_fsm_soe_error;