diff --git a/sched/wqueue/kwork_inherit.c b/sched/wqueue/kwork_inherit.c
index b6d98c7b406..a960480bd05 100644
--- a/sched/wqueue/kwork_inherit.c
+++ b/sched/wqueue/kwork_inherit.c
@@ -110,6 +110,11 @@ static void lpwork_boostworker(pid_t wpid, uint8_t reqprio)
                   wtcb->pend_reprios[wtcb->npend_reprio] = wtcb->sched_priority;
                   wtcb->npend_reprio++;
                 }
+              else
+                {
+                  serr("ERROR: CONFIG_SEM_NNESTPRIO exceeded\n");
+                  DEBUGASSERT(wtcb->npend_reprio < CONFIG_SEM_NNESTPRIO);
+                }
             }
 
           /* Raise the priority of the worker.  This cannot cause a context
@@ -129,8 +134,16 @@ static void lpwork_boostworker(pid_t wpid, uint8_t reqprio)
            * saved priority and not to the base priority.
            */
 
-          wtcb->pend_reprios[wtcb->npend_reprio] = reqprio;
-          wtcb->npend_reprio++;
+          if (wtcb->npend_reprio < CONFIG_SEM_NNESTPRIO)
+            {
+              wtcb->pend_reprios[wtcb->npend_reprio] = reqprio;
+              wtcb->npend_reprio++;
+            }
+          else
+            {
+              serr("ERROR: CONFIG_SEM_NNESTPRIO exceeded\n");
+              DEBUGASSERT(wtcb->npend_reprio < CONFIG_SEM_NNESTPRIO);
+            }
         }
     }
 #else