Add read_failed callback to DeckCtrlElement for memory read failures

Author: gemenerik

cflib/crazyflie/mem/__init__.py

@@ -538,6 +538,7 @@ def _handle_cmd_info_details(self, payload):
                 mem = DeckCtrlElement(id=mem_id, type=mem_type, size=mem_size, mem_handler=self)
                 logger.debug(mem)
                 self.mem_read_cb.add_callback(mem.new_data)
+                self.mem_read_failed_cb.add_callback(mem.read_failed)
             else:
                 mem = MemoryElement(id=mem_id, type=mem_type, size=mem_size, mem_handler=self)
                 logger.debug(mem)

cflib/crazyflie/mem/deckctrl_element.py

@@ -76,6 +76,14 @@ def new_data(self, mem, addr, data):
                     self._update_finished_cb(self)
                     self._update_finished_cb = None
 
+    def read_failed(self, mem, addr):
+        """Callback for when a memory read fails"""
+        if mem.id == self.id:
+            logger.warning('DeckCtrl memory read failed for id {}'.format(self.id))
+            if self._update_finished_cb:
+                self._update_finished_cb(self)
+                self._update_finished_cb = None
+
     def _parse_and_check_info(self, data):
         """Parse and validate the DeckCtrl info block"""
         if len(data) < DECKCTRL_INFO_SIZE: