diff --git a/eive_tmtc/pus_tm/pus_handler.py b/eive_tmtc/pus_tm/pus_handler.py
index e6d9d7a..ccd09f9 100644
--- a/eive_tmtc/pus_tm/pus_handler.py
+++ b/eive_tmtc/pus_tm/pus_handler.py
@@ -109,7 +109,7 @@ class PusHandler(SpecificApidHandlerBase):
         elif service == 20:
             self._handle_param_packet(packet, tm_packet)
         elif service == 200:
-            dedicated_handler = self._handle_mode_packet(packet, tm_packet)
+            dedicated_handler = self._handle_mode_packet(tm_packet)
         else:
             _LOGGER.info(
                 f"The service {service} is not implemented in Telemetry Factory"
@@ -207,6 +207,7 @@ class PusHandler(SpecificApidHandlerBase):
             return True
         if tm_packet.tm.subservice == ModeSubservice.TM_WRONG_MODE_REPLY:
             self.pw.dlog(f"Received Mode TM wrong mode reply, mode: {tm_packet.mode}")
+            return True
         return False