lichao
2021-04-28 a6f67b4249525089fb97eb9418c7014f66c2a000
src/shm_queue.h
@@ -21,105 +21,70 @@
#include "shm.h"
#include <atomic>
#include <boost/circular_buffer.hpp>
#include <boost/date_time/posix_time/posix_time.hpp>
#include <chrono>
namespace bhome_shm
{
template <class D>
using Circular = boost::circular_buffer<D, Allocator<D>>;
using Circular = robust::CircularBuffer<D, Allocator<D>>;
template <class D>
class SharedQueue : private Circular<D>
class SharedQueue
{
   typedef Circular<D> Super;
   Mutex mutex_;
   Cond cond_read_;
   Cond cond_write_;
   Mutex &mutex() { return mutex_; }
   static boost::posix_time::ptime MSFromNow(const int ms)
   {
      using namespace boost::posix_time;
      ptime cur = boost::posix_time::microsec_clock::universal_time();
      return cur + millisec(ms);
   }
   auto TimedReadPred(const int timeout_ms)
   {
      auto endtime = MSFromNow(timeout_ms);
      return [this, endtime](Guard &lock) {
         return (cond_read_.timed_wait(lock, endtime, [&]() { return !this->empty(); }));
      };
   }
   auto TryReadPred()
   {
      return [this](Guard &lock) { return !this->empty(); };
   }
   template <class Pred>
   bool ReadOnCond(D &buf, Pred const &pred)
   {
      auto Read = [&]() {
         Guard lock(this->mutex());
         if (pred(lock)) {
            using std::swap;
            swap(buf, Super::front());
            Super::pop_front();
            return true;
         } else {
            return false;
         }
      };
      return Read() ? (this->cond_write_.notify_one(), true) : false;
   }
   template <class Iter, class Pred, class OnWrite>
   int WriteAllOnCond(Iter begin, Iter end, Pred const &pred, OnWrite const &onWrite)
   {
      if (begin == end) { return 0; }
      int n = 0;
      Guard lock(mutex());
      while (pred(lock)) {
         onWrite(*begin);
         Super::push_back(*begin);
         ++n;
         cond_read_.notify_one();
         if (++begin == end) {
            break;
         }
      }
      return n;
   }
public:
   SharedQueue(const uint32_t len, Allocator<D> const &alloc) :
       Super(len, alloc) {}
   template <class Iter, class OnWrite>
   int TryWrite(Iter begin, Iter end, const OnWrite &onWrite)
   {
      auto tryWritePred = [this](Guard &lock) { return !this->full(); };
      return WriteAllOnCond(begin, end, tryWritePred, onWrite);
   }
       queue_(len, alloc) {}
   template <class OnWrite>
   bool TryWrite(const D &buf, const OnWrite &onWrite) { return TryWrite(&buf, (&buf) + 1, onWrite); }
   bool TryWrite(const D &buf)
   bool TryWrite(const D &d, const OnWrite &onWrite)
   {
      return TryWrite(buf, [](const D &buf) {});
      Guard lock(mutex());
      if (!queue_.full()) {
         onWrite(d);
         queue_.push_back(d);
         return true;
      } else {
         return false;
      }
   }
   template <class OnData>
   int ReadAll(const int timeout_ms, OnData const &onData) { return ReadAllOnCond(TimedReadPred(timeout_ms), onData); }
   template <class OnData>
   int TryReadAll(OnData const &onData) { return ReadAllOnCond(TryReadPred(), onData); }
   bool TryWrite(const D &d)
   {
      Guard lock(mutex());
      return !queue_.full() ? (queue_.push_back(d), true) : false;
   }
   bool Read(D &buf, const int timeout_ms) { return ReadOnCond(buf, TimedReadPred(timeout_ms)); }
   bool TryRead(D &buf) { return ReadOnCond(buf, TryReadPred()); }
   bool Read(D &d, const int timeout_ms)
   {
      using namespace std::chrono;
      auto end_time = steady_clock::now() + milliseconds(timeout_ms);
      do {
         if (TryRead(d)) {
            return true;
         } else {
            robust::QuickSleep();
         }
      } while (steady_clock::now() < end_time);
      return false;
   }
   bool TryRead(D &d)
   {
      Guard lock(mutex());
      if (!queue_.empty()) {
         queue_.pop_front(d);
         return true;
      } else {
         return false;
      }
   }
private:
   typedef Circular<D> Queue;
   Queue queue_;
   Mutex mutex_;
   Mutex &mutex() { return mutex_; }
};
} // namespace bhome_shm