1 files changed, 10 insertions, 13 deletions

diff --git a/os/kernel/src/chqueues.c b/os/kernel/src/chqueues.c
index cf3d21732..b32ccf803 100644
--- a/os/kernel/src/chqueues.c
+++ b/os/kernel/src/chqueues.c
@@ -152,9 +152,8 @@ msg_t chIQPutI(InputQueue *iqp, uint8_t b) {
  * @details This function reads a byte value from an input queue. If the queue

  *          is empty then the calling thread is suspended until a byte arrives

  *          in the queue or a timeout occurs.

- * @note    The callback is invoked if the queue is empty before entering the

- *          @p THD_STATE_WTQUEUE state in order to solicit the low level to

- *          start queue filling.

+ * @note    The callback is invoked before reading the character from the

+ *          buffer or before entering the state @p THD_STATE_WTQUEUE.

  *

  * @param[in] iqp       pointer to an @p InputQueue structure

  * @param[in] time      the number of ticks before the operation timeouts,

@@ -172,12 +171,11 @@ msg_t chIQGetTimeout(InputQueue *iqp, systime_t time) {
   uint8_t b;

 

   chSysLock();

+  if (iqp->q_notify)

+    iqp->q_notify(iqp);

+

   while (chIQIsEmptyI(iqp)) {

     msg_t msg;

-

-    if (iqp->q_notify)

-      iqp->q_notify(iqp);

-

     if ((msg = qwait((GenericQueue *)iqp, time)) < Q_OK) {

       chSysUnlock();

       return msg;

@@ -201,9 +199,8 @@ msg_t chIQGetTimeout(InputQueue *iqp, systime_t time) {
  *          been reset.

  * @note    The function is not atomic, if you need atomicity it is suggested

  *          to use a semaphore or a mutex for mutual exclusion.

- * @note    The callback is invoked if the queue is empty before entering the

- *          @p THD_STATE_WTQUEUE state in order to solicit the low level to

- *          start queue filling.

+ * @note    The callback is invoked before reading each character from the

+ *          buffer or before entering the state @p THD_STATE_WTQUEUE.

  *

  * @param[in] iqp       pointer to an @p InputQueue structure

  * @param[out] bp       pointer to the data buffer

@@ -227,10 +224,10 @@ size_t chIQReadTimeout(InputQueue *iqp, uint8_t *bp,
 

   chSysLock();

   while (TRUE) {

-    while (chIQIsEmptyI(iqp)) {

-      if (nfy)

-        nfy(iqp);

+    if (nfy)

+      nfy(iqp);

 

+    while (chIQIsEmptyI(iqp)) {

       if (qwait((GenericQueue *)iqp, time) != Q_OK) {

         chSysUnlock();

         return r;