Merge pull request #95 from ros-drivers/buffer_queue_size_really_1

When setting queue_size to 1, we actually had 2 images in the buffer,…

Author: awesomebytes

src/video_stream.cpp

@@ -156,7 +156,7 @@ virtual void do_capture() {
         if(!frame.empty()) {
             std::lock_guard<std::mutex> g(q_mutex);
             // accumulate only until max_queue_size
-            while (framesQueue.size() > latest_config.buffer_queue_size) {
+            while (framesQueue.size() >= latest_config.buffer_queue_size) {
               framesQueue.pop();
             }
             framesQueue.push(frame.clone());