1 files changed, 4 insertions, 1 deletions
diff --git a/test/testbmk.c b/test/testbmk.c
index 0f38eb78b..7e7a714df 100644
--- a/test/testbmk.c
+++ b/test/testbmk.c
@@ -65,11 +65,14 @@ static Mutex mtx1;
 #endif
 
 static msg_t thread1(void *p) {
+  Thread *tp;
   msg_t msg;
 
   (void)p;
   do {
-    chMsgRelease(msg = chMsgWait());
+    tp = chMsgWait();
+    msg = chMsgGet(tp);
+    chMsgRelease(tp, msg);
   } while (msg);
   return 0;
 }