add queue length status.

lichao

2021-03-31 4353f73ea0c30c776a3957dc674d750e51519ca3

 src/socket.cpp

@@ -17,118 +17,127 @@
 */

#include "socket.h"
#include <chrono>
#include "msg.h"
#include "defs.h"
#include "bh_util.h"
#include "defs.h"
#include "msg.h"

using namespace bhome_msg;
using namespace bhome_shm;
using namespace std::chrono_literals;

namespace {

int GetSocketDefaultLen(ShmSocket::Type type) 
namespace
{
    switch (type) {
        case ShmSocket::eSockRequest : return 12;
        case ShmSocket::eSockReply : return 64;
        case ShmSocket::eSockPublish : return 0;
        case ShmSocket::eSockSubscribe : return 64;
        default: return 0;
    }
}

} // namespace

}

ShmSocket::ShmSocket(Type type, bhome_shm::SharedMemory &shm)
    : shm_(shm),
      type_(type),
      run_(false)
ShmSocket::ShmSocket(Type type, bhome_shm::SharedMemory &shm) :
    shm_(shm), type_(type), run_(false)
{
    int len = GetSocketDefaultLen(type);
    if (len != 0) {
        mq_.reset(new Queue(shm_, len));
   switch (type) {
   case eSockBus: mq_.reset(new Queue(kBHBusQueueId, shm_, 1000)); break;
   case eSockRequest: mq_.reset(new Queue(shm_, 12)); break;
   case eSockReply: mq_.reset(new Queue(shm_, 64)); break;
   case eSockSubscribe: mq_.reset(new Queue(shm_, 64)); break;
   case eSockPublish: break; // no recv mq needed
   default: break;
   }
}

        auto RecvProc = [this](){
            while (run_) {
                try {
                    std::unique_lock<std::mutex> lk(mutex_);
                    if (cv_recv_cb_.wait_for(lk, 100ms, [this](){ return HasRecvCB(); })) {
                        BHMsg msg;
                        if (mq_->Recv(msg, 100)) {
                            this->onRecv_(msg);
                        }
                    }
                } catch (...) {}
            }
        };
        run_.store(true);
        workers_.emplace_back(RecvProc);
    }
}
ShmSocket::ShmSocket(Type type)
    : ShmSocket(type, BHomeShm())
{
}
ShmSocket::ShmSocket(Type type) :
    ShmSocket(type, BHomeShm()) {}

ShmSocket::~ShmSocket()
{
    Stop();
   Stop();
}

bool ShmSocket::Publish(const std::string &topic, const void *data, const size_t size, const int timeout_ms)
{
    if (type_ != eSockPublish) {
        return false;
    }
    assert(!mq_);
    try {
        MsgI imsg;
        if (!imsg.MakeRC(shm_, MakePub(topic, data, size))) {
            return false;
        }
        DEFER1(imsg.Release(shm_));
        return Queue::Send(shm_, kBHBusQueueId, imsg, timeout_ms);
        
    } catch (...) {
        return false;
    }
   if (type_ != eSockPublish) {
      return false;
   }
   assert(!mq_);
   try {
      MsgI imsg;
      if (!imsg.MakeRC(shm_, MakePub(topic, data, size))) {
         return false;
      }
      DEFER1(imsg.Release(shm_));
      return Queue::Send(shm_, kBHBusQueueId, imsg, timeout_ms);
   } catch (...) {
      return false;
   }
}

bool ShmSocket::Subscribe(const std::vector<std::string> &topics, const int timeout_ms)
{
    if (type_ != eSockSubscribe) {
        return false;
    }
    assert(mq_);
    try {
        return mq_->Send(kBHBusQueueId, MakeSub(mq_->Id(), topics), timeout_ms);
    } catch (...) {
        return false;
    }
   if (type_ != eSockSubscribe) {
      return false;
   }
   assert(mq_);
   try {
      return mq_->Send(kBHBusQueueId, MakeSub(mq_->Id(), topics), timeout_ms);
   } catch (...) {
      return false;
   }
}

bool ShmSocket::SetRecvCallback(const RecvCB &onRecv)
bool ShmSocket::StartRaw(const RecvRawCB &onData, int nworker)
{
    std::lock_guard<std::mutex> lock(mutex_);
    onRecv_ = onRecv;
    cv_recv_cb_.notify_one();
    return true;
   auto CanRecv = [this]() {
      switch (type_) {
      case eSockRequest:
      case eSockReply:
      case eSockBus:
      case eSockSubscribe:
         return true;
      default:
         return false;
      }
   };
   if (!CanRecv()) {
      return false;
   }
   std::lock_guard<std::mutex> lock(mutex_);

   StopNoLock();
   auto RecvProc = [this, onData]() {
      while (run_) {
         try {
            MsgI imsg;
            DEFER1(imsg.Release(shm_));
            if (mq_->Recv(imsg, 100)) { onData(imsg); }
         } catch (...) {
         }
      }
   };

   run_.store(true);
   for (int i = 0; i < nworker; ++i) {
      workers_.emplace_back(RecvProc);
   }
   return true;
}

bool ShmSocket::HasRecvCB()
bool ShmSocket::Start(const RecvCB &onData, int nworker)
{
    return static_cast<bool>(onRecv_);
   return StartRaw([this, onData](MsgI &imsg) { BHMsg m; if (imsg.Unpack(m)) { onData(m); } }, nworker);
}

void ShmSocket::Stop()
bool ShmSocket::Stop()
{
    run_ = false;
    for (auto &t : workers_) {
        if (t.joinable()) {
            t.join();
        }
    }
}
   std::lock_guard<std::mutex> lock(mutex_);
   return StopNoLock();
}

bool ShmSocket::StopNoLock()
{
   if (run_.exchange(false)) {
      for (auto &w : workers_) {
         if (w.joinable()) {
            w.join();
         }
      }
      return true;
   }
   return false;
}