lichao
2021-04-16 c6964d5af25d4ec7ed9dbe7674dc4e3896b36ead
src/socket.cpp
@@ -17,118 +17,114 @@
 */
#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(Shm &shm, const MQId &id, const int len) :
    run_(false), mq_(id, shm, len)
{
    int len = GetSocketDefaultLen(type);
    if (len != 0) {
        mq_.reset(new Queue(shm_, len));
        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);
    }
   Start();
}
ShmSocket::ShmSocket(Type type)
    : ShmSocket(type, BHomeShm())
ShmSocket::ShmSocket(bhome_shm::SharedMemory &shm, const int len) :
    run_(false), mq_(shm, len)
{
   Start();
}
ShmSocket::~ShmSocket()
{
    Stop();
   Stop(); //TODO should stop in sub class, incase thread access sub class data.
}
bool ShmSocket::Publish(const std::string &topic, const void *data, const size_t size, const int timeout_ms)
bool ShmSocket::Start(int nworker, const RecvCB &onData, const IdleCB &onIdle)
{
    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;
    }
   auto ioProc = [this, onData, onIdle]() {
      auto DoSend = [this]() { return send_buffer_.TrySend(mq()); };
      auto DoRecv = [=] {
         auto onRecvWithPerMsgCB = [this, onData](ShmSocket &socket, MsgI &imsg, BHMsgHead &head) {
            RecvCB cb;
            if (per_msg_cbs_->Find(head.msg_id(), cb)) {
               cb(socket, imsg, head);
            } else if (onData) {
               onData(socket, imsg, head);
            }
         };
         // do not recv if no cb is set.
         if (!onData && per_msg_cbs_->empty()) {
            return false;
         }
         auto onMsg = [&](MsgI &imsg) {
            DEFER1(imsg.Release(shm()));
            BHMsgHead head;
            if (imsg.ParseHead(head)) {
               onRecvWithPerMsgCB(*this, imsg, head);
            }
         };
         return mq().TryRecvAll(onMsg) > 0; // this will recv all msgs.
      };
      try {
         bool more_to_send = DoSend();
         bool more_to_recv = DoRecv();
         if (onIdle) { onIdle(*this); }
         if (!more_to_send && !more_to_recv) {
            std::this_thread::yield();
         }
      } catch (...) {
      }
   };
   std::lock_guard<std::mutex> lock(mutex_);
   StopNoLock();
   run_.store(true);
   for (int i = 0; i < nworker; ++i) {
      workers_.emplace_back([this, ioProc]() { while (run_) { ioProc(); } });
   }
   return true;
}
bool ShmSocket::Subscribe(const std::vector<std::string> &topics, const int timeout_ms)
bool ShmSocket::Stop()
{
    if (type_ != eSockSubscribe) {
        return false;
    }
    assert(mq_);
    try {
        return mq_->Send(kBHBusQueueId, MakeSub(mq_->Id(), topics), timeout_ms);
    } catch (...) {
        return false;
    }
   std::lock_guard<std::mutex> lock(mutex_);
   return StopNoLock();
}
bool ShmSocket::SetRecvCallback(const RecvCB &onRecv)
bool ShmSocket::StopNoLock()
{
    std::lock_guard<std::mutex> lock(mutex_);
    onRecv_ = onRecv;
    cv_recv_cb_.notify_one();
    return true;
   if (run_.exchange(false)) {
      for (auto &w : workers_) {
         if (w.joinable()) {
            w.join();
         }
      }
      workers_.clear();
      return true;
   }
   return false;
}
bool ShmSocket::HasRecvCB()
//maybe reimplment, using async cbs?
bool ShmSocket::SyncRecv(bhome_msg::MsgI &msg, bhome::msg::BHMsgHead &head, const int timeout_ms)
{
    return static_cast<bool>(onRecv_);
   // std::lock_guard<std::mutex> lock(mutex_); // seems no need to lock mutex_.
   bool got = (timeout_ms == 0) ? mq().TryRecv(msg) : mq().Recv(msg, timeout_ms);
   if (got) {
      if (msg.ParseHead(head)) {
         return true;
      } else {
         msg.Release(shm());
      }
   }
   return false;
}
void ShmSocket::Stop()
{
    run_ = false;
    for (auto &t : workers_) {
        if (t.joinable()) {
            t.join();
        }
    }
}