Needed the status register

nasa-jpl · Sep 11, 2024 · 2831d49 · 2831d49
1 parent 9ac8436
commit 2831d49
Showing 1 changed file with 9 additions and 0 deletions.
diff --git a/src/jsd_epd_nominal.c b/src/jsd_epd_nominal.c
@@ -830,6 +830,15 @@ void jsd_epd_nominal_update_state_from_PDO_data(jsd_t*   self,
       WARNING("%i ", statusword_uint & 0x01);
       statusword_uint = statusword_uint >> 1;
     }
+    WARNING("\n We got STO Engaged! Here's the Status Register:\n");
+    unsigned int status_register_1_uint = (unsigned int)self->slave_states[slave_id].epd_nominal.txpdo.status_register_1;
+    WARNING("Bits of txpdo status register:\n");
+    for(long unsigned int bit=0;bit<(sizeof(unsigned int) * 8); bit++)
+    {
+      WARNING("%i ", status_register_1_uint & 0x01);
+      status_register_1_uint = status_register_1_uint >> 1;
+    }
+    WARNING("\n");
     WARNING("\n");
   }