diff --git a/master/fsm_pdo_assign.c b/master/fsm_pdo_assign.c
index eacad10db68d10227f339509ebcb3b41bb6600af..2f36d962e5a23dc95a80e55fe454ed07395f7ba7 100644
--- a/master/fsm_pdo_assign.c
+++ b/master/fsm_pdo_assign.c
@@ -152,6 +152,7 @@ void ec_fsm_pdo_assign_state_start(
     }
 
     fsm->dir = (ec_direction_t) -1; // next is EC_DIR_OUTPUT
+    fsm->num_configured_dirs = 0;
     ec_fsm_pdo_assign_next_dir(fsm);
 }
 
@@ -191,6 +192,8 @@ void ec_fsm_pdo_assign_next_dir(
             return;
         }
 
+        fsm->num_configured_dirs++;
+
         if (fsm->slave->master->debug_level) {
             EC_DBG("Changing Pdo assignment for SM%u of slave %u.\n",
                     fsm->sync->index, fsm->slave->ring_position);
@@ -215,9 +218,9 @@ void ec_fsm_pdo_assign_next_dir(
         return;
     }
 
-    if (fsm->slave->master->debug_level)
-        EC_DBG("Pdo assignment finished for slave %u.\n",
-                fsm->slave->ring_position);
+    if (fsm->slave->master->debug_level && !fsm->num_configured_dirs)
+        EC_DBG("Pdo assignments of slave %u are already configured"
+                " correctly.\n", fsm->slave->ring_position);
     fsm->state = ec_fsm_pdo_assign_state_end;
 }
 
@@ -348,8 +351,8 @@ void ec_fsm_pdo_assign_state_pdo_count(
     }
 
     if (fsm->slave->master->debug_level)
-        EC_DBG("Successfully set Pdo assignment for SM%u of slave %u.\n",
-                fsm->sync->index, fsm->slave->ring_position);
+        EC_DBG("Successfully configured Pdo assignment for SM%u of"
+                " slave %u.\n", fsm->sync->index, fsm->slave->ring_position);
 
     // assignment for this direction finished
     ec_fsm_pdo_assign_next_dir(fsm);
diff --git a/master/fsm_pdo_assign.h b/master/fsm_pdo_assign.h
index 436e1f70855c34e90d36fd72874470cbccde4a7e..7e88d7a93cc284e421b77400cb8c80b8270dbc28 100644
--- a/master/fsm_pdo_assign.h
+++ b/master/fsm_pdo_assign.h
@@ -63,8 +63,9 @@ struct ec_fsm_pdo_assign
     ec_slave_t *slave; /**< Slave the FSM runs on. */
 
     ec_direction_t dir; /**< Current direction. */
-    const ec_sync_t *sync; /**< Current sync manager. */
     const ec_pdo_list_t *pdos; /**< Target Pdo assignment. */
+    const ec_sync_t *sync; /**< Current sync manager. */
+    unsigned int num_configured_dirs; /**< Number of configured directions. */
     const ec_pdo_t *pdo; /**< Current Pdo. */
 
     ec_sdo_request_t request; /**< Sdo request. */
diff --git a/master/fsm_pdo_mapping.c b/master/fsm_pdo_mapping.c
index 0d984cbed9304b9d6c0b401c021fccaaae0f79a4..ebcf1c5a9534733f3ad78b7109fc8d4da52edc47 100644
--- a/master/fsm_pdo_mapping.c
+++ b/master/fsm_pdo_mapping.c
@@ -149,6 +149,7 @@ void ec_fsm_pdo_mapping_state_start(
     }
 
     fsm->pdo = NULL;
+    fsm->num_configured_pdos = 0;
     ec_fsm_pdo_mapping_next_pdo(fsm);
 }
 
@@ -169,7 +170,7 @@ void ec_fsm_pdo_mapping_next_pdo(
 
         list_for_each_entry(pdo, &pdos->list, list) {
             if (fsm->pdo) { // there was a Pdo mapping changed in the last run
-                if (pdo == fsm->pdo) // this is the last Pdo
+                if (pdo == fsm->pdo) // this is the previously configured Pdo
                     fsm->pdo = NULL; // take the next one
             } else {
                 if ((assigned_pdo = ec_slave_find_pdo(fsm->slave, pdo->index)))
@@ -177,15 +178,16 @@ void ec_fsm_pdo_mapping_next_pdo(
                         continue; // Pdo entries mapped correctly
 
                 fsm->pdo = pdo;
+                fsm->num_configured_pdos++;
                 break;
             }
         }
     }
 
     if (!fsm->pdo) {
-        if (fsm->slave->master->debug_level)
-            EC_DBG("Pdo mapping finished for slave %u.\n",
-                    fsm->slave->ring_position);
+        if (fsm->slave->master->debug_level && !fsm->num_configured_pdos)
+            EC_DBG("Pdo mappings of slave %u are already configured"
+                    " correctly.\n", fsm->slave->ring_position);
         fsm->state = ec_fsm_pdo_mapping_state_end;
         return;
     }
diff --git a/master/fsm_pdo_mapping.h b/master/fsm_pdo_mapping.h
index 753f0836a44dd896af2b3c718c528449cc0c92cd..e0e3f21e63866d14cfe7a0e145ada78e7ec1cdbc 100644
--- a/master/fsm_pdo_mapping.h
+++ b/master/fsm_pdo_mapping.h
@@ -61,6 +61,7 @@ struct ec_fsm_pdo_mapping
     ec_slave_t *slave; /**< Slave the FSM runs on. */
 
     const ec_pdo_t *pdo; /**< Current Pdo to configure. */
+    unsigned int num_configured_pdos; /**< Number of configured Pdos. */
     const ec_pdo_entry_t *entry; /**< Current entry. */
 
     ec_sdo_request_t request; /**< Sdo request. */