diff --git a/master/fsm_coe_map.c b/master/fsm_coe_map.c
index 5033e004be2c27b203b7a3278e0267e3351fa4f7..ba3fed2a6898cecf823f170d07da7cc4ee8fc0b7 100644
--- a/master/fsm_coe_map.c
+++ b/master/fsm_coe_map.c
@@ -44,6 +44,10 @@
 #include "sdo_request.h"
 #include "fsm_coe_map.h"
 
+/** Retry reading the number of assigned Pdos if this time is not elapsed.
+ */
+#define EC_FSM_COE_MAP_TIMEOUT 5
+
 /*****************************************************************************/
 
 void ec_fsm_coe_map_state_start(ec_fsm_coe_map_t *);
@@ -183,7 +187,7 @@ void ec_fsm_coe_map_action_next_dir(
 
         ec_sdo_request_address(&fsm->request, fsm->sync_sdo_index, 0);
         ecrt_sdo_request_read(&fsm->request);
-        fsm->retries = 5;
+        fsm->jiffies_start = jiffies;
         fsm->state = ec_fsm_coe_map_state_pdo_count;
         ec_fsm_coe_transfer(fsm->fsm_coe, fsm->slave, &fsm->request);
         ec_fsm_coe_exec(fsm->fsm_coe); // execute immediately
@@ -210,7 +214,7 @@ void ec_fsm_coe_map_state_pdo_count(
     if (ec_fsm_coe_exec(fsm->fsm_coe)) return;
 
     if (!ec_fsm_coe_success(fsm->fsm_coe)) {
-        if (fsm->retries--) {
+        if (jiffies - fsm->jiffies_start < HZ * EC_FSM_COE_MAP_TIMEOUT) {
             if (fsm->slave->master->debug_level)
                 EC_DBG("Failed to read number of assigned Pdos from "
                         "slave %u. Retrying...\n", fsm->slave->ring_position);
diff --git a/master/fsm_coe_map.h b/master/fsm_coe_map.h
index 17dce52dcf645782a2e60e4e574413a112f5eed4..fb71b8796c90baba496aae32f62bdcd93764c630 100644
--- a/master/fsm_coe_map.h
+++ b/master/fsm_coe_map.h
@@ -73,7 +73,7 @@ struct ec_fsm_coe_map
     uint8_t pdo_subindices; /**< Number of Pdo entries. */
     uint16_t pdo_subindex; /**< Current subindex in Pdo Sdo. */
 
-    unsigned int retries; /**< Retry count. */
+    unsigned long jiffies_start; /**< Timestamp. */
 };
 
 /*****************************************************************************/