diff --git a/os/nil/osal/osal.c b/os/nil/osal/osal.c
index 564ee369d..d2927bc12 100644
--- a/os/nil/osal/osal.c
+++ b/os/nil/osal/osal.c
@@ -68,6 +68,7 @@ void osalThreadDequeueNextI(threads_queue_t *tqp, msg_t msg) {
     while (true) {
       /* Is this thread waiting on this semaphore?*/
       if (tr->u1.semp == sp) {
+        sp->cnt++;
 
         chDbgAssert(NIL_THD_IS_WTSEM(tr), "not waiting");
 
diff --git a/os/nil/src/nil.c b/os/nil/src/nil.c
index 9141129cb..bafcb63cd 100644
--- a/os/nil/src/nil.c
+++ b/os/nil/src/nil.c
@@ -566,6 +566,7 @@ void chSemSignalI(semaphore_t *sp) {
     while (true) {
       /* Is this thread waiting on this semaphore?*/
       if (tr->u1.semp == sp) {
+        sp->cnt++;
 
         chDbgAssert(NIL_THD_IS_WTSEM(tr), "not waiting");