change queue behavior for packets read from node while no client is connected

[tinyos-2.x.git] / support / sdk / cpp / sf / serialcomm.cpp

diff --git a/support/sdk/cpp/sf/serialcomm.cpp b/support/sdk/cpp/sf/serialcomm.cpp
index ea4e4bfa142401c7a3d3735206aee5f680bc18bc..5920a7240259b0901db6c3f2a28ebf713be244b2 100644 (file)
--- a/support/sdk/cpp/sf/serialcomm.cpp
+++ b/support/sdk/cpp/sf/serialcomm.cpp
@@ -642,7 +642,11 @@ void SerialComm::readSerial()
             }
             else
             {
-                ++droppedReadPacketCount;
+                while(readBuffer.isFull()) {
+                    readBuffer.dequeue();
+                    ++droppedReadPacketCount;
+                }
+                readBuffer.enqueueBack(packet);
                 // DEBUG("SerialComm::readSerial : dropped packet")
             }
         }