git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@2036 35acf78f-673a-0410-8e92-d51de3d6d3f4

1 files changed, 4 insertions, 3 deletions

diff --git a/os/kernel/src/chqueues.c b/os/kernel/src/chqueues.c
index 84cbbed94..d1aa03cc6 100644
--- a/os/kernel/src/chqueues.c
+++ b/os/kernel/src/chqueues.c
@@ -126,6 +126,10 @@ msg_t chIQGetTimeout(InputQueue *iqp, systime_t time) {
   msg_t msg;

 

   chSysLock();

+  

+  if (iqp->q_notify)

+    iqp->q_notify();

+

   if ((msg = chSemWaitTimeoutS(&iqp->q_sem, time)) < RDY_OK) {

     chSysUnlock();

     return msg;

@@ -134,9 +138,6 @@ msg_t chIQGetTimeout(InputQueue *iqp, systime_t time) {
   if (iqp->q_rdptr >= iqp->q_top)

     iqp->q_rdptr = iqp->q_buffer;

 

-  if (iqp->q_notify)

-    iqp->q_notify();

-

   chSysUnlock();

   return b;

 }