lichao
2021-05-21 11f6c600e55ca5677f93624efe44d2605cdd908d
src/topic_node.cpp
@@ -17,6 +17,7 @@
 */
#include "topic_node.h"
#include "bh_util.h"
#include "sleeper.h"
#include <chrono>
#include <list>
@@ -28,7 +29,17 @@
namespace
{
inline void AddRoute(BHMsgHead &head, const MQId id) { head.add_route()->set_mq_id(id); }
bool ValidUserSymbol(const std::string &s)
{
   return !s.empty() && s[0] != '#' && s[0] != '@';
}
inline void AddRoute(BHMsgHead &head, const ShmSocket &sock)
{
   auto route = head.add_route();
   route->set_mq_id(sock.id());
   route->set_abs_addr(sock.AbsAddr());
}
struct SrcInfo {
   std::vector<BHAddress> route;
@@ -40,13 +51,12 @@
} // namespace
TopicNode::TopicNode(SharedMemory &shm) :
    shm_(shm), state_(eStateUnregistered)
    shm_(shm), state_(eStateUninited)
{
}
TopicNode::~TopicNode()
{
   LOG_DEBUG() << "~TopicNode()";
   Stop();
}
@@ -61,73 +71,57 @@
   }
   if (ssn_id_ == 0) {
      ssn_id_ = ShmMsgQueue::NewId();
      ssn_id_ = NewSession();
   }
   LOG_DEBUG() << "Node Init, id " << ssn_id_;
   auto NodeInit = [&]() {
      auto SendInitCmd = [&]() {
         int64_t init_cmd = ssn_id_ << 4 | EncodeCmd(eCmdNodeInit);
         auto end_time = steady_clock::now() + 3s;
         bool r = false;
         do {
            r = ShmMsgQueue::TrySend(shm(), BHTopicCenterAddress(), init_cmd);
         } while (!r && steady_clock::now() < end_time);
         return r;
      };
      if (SendInitCmd()) {
         LOG_DEBUG() << "node send init ok";
         auto end_time = steady_clock::now() + 3s;
         do {
            try {
               for (int i = eSockStart; i < eSockEnd; ++i) {
                  sockets_.emplace_back(new ShmSocket(shm_, false, ssn_id_ + i, kMqLen));
               }
               break;
            } catch (...) {
               sockets_.clear();
               std::this_thread::sleep_for(100ms);
            }
         } while (steady_clock::now() < end_time);
      int64_t init_request = ssn_id_ << 4 | EncodeCmd(eCmdNodeInit);
      int64_t reply = 0;
      if (BHNodeInit(shm(), init_request, reply) && DecodeCmd(reply) == eCmdNodeInitReply) {
         int64_t abs_addr = reply >> 4;
         sockets_.emplace_back(new ShmSocket(abs_addr, shm_, ssn_id_));
         LOG_DEBUG() << "node init ok";
      } else {
         LOG_ERROR() << "Node Init Error";
      }
   };
   if (sockets_.empty()) {
      NodeInit();
   }
   if (!sockets_.empty()) {
      LOG_DEBUG() << "node sockets ok";
      auto onNodeCmd = [this](ShmSocket &socket, int64_t &val) {
         LOG_DEBUG() << "node recv cmd: " << DecodeCmd(val);
         switch (DecodeCmd(val)) {
         case eCmdNodeInitReply: {
            MsgI msg(val >> 4);
            DEFER1(msg.Release());
      auto onMsg = [this](ShmSocket &socket, MsgI &imsg, BHMsgHead &head) {
         LOG_DEBUG() << "node recv type: " << head.type();
         switch (head.type()) {
         case kMsgTypeProcInit: {
            // reuse msg to send proc init.
            MsgProcInit body;
            body.set_extra_mq_num(eSockEnd - eSockStart - 1);
            auto head = InitMsgHead(GetType(body), info_.proc_id(), ssn_id_);
            head.add_route()->set_mq_id(ssn_id_);
            if (msg.Fill(head, body)) {
               socket.Send(BHTopicCenterAddress(), msg);
            AddRoute(head, socket);
            if (imsg.Fill(head, body)) {
               socket.Send(CenterAddr(), imsg);
            }
         } break;
         default:
            break;
         }
         return true;
      };
      // recv msgs to avoid memory leak.
      auto onMsg = [this](ShmSocket &sock, MsgI &imsg, BHMsgHead &head) {
         LOG_DEBUG() << "node recv type: " << head.type();
         if (head.type() == kMsgTypeProcInitReply) {
         case kMsgTypeProcInitReply: {
            LOG_DEBUG() << "got proc init reply";
            MsgProcInitReply reply;
            if (imsg.ParseBody(reply)) {
            if (imsg.ParseBody(reply) && IsSuccess(reply.errmsg().errcode())) {
               for (auto &addr : reply.extra_mqs()) {
                  LOG_DEBUG() << "add socket " << addr.abs_addr() << ", id:" << addr.mq_id();
                  sockets_.emplace_back(new ShmSocket(addr.abs_addr(), shm(), addr.mq_id()));
               }
               SetProcIndex(reply.proc_index());
               this->state_ = eStateUnregistered;
               ServerStart(ServerAsyncCB(), 1);
               SubscribeStartWorker(SubDataCB(), 1);
            }
         } break;
         default: break;
         }
         return true;
      };
      SockNode().Start(1, onMsg, onNodeCmd);
      LOG_DEBUG() << "sockets ok.";
      SockNode().Start(1, onMsg);
      return true;
   }
   return false;
@@ -151,13 +145,16 @@
}
void TopicNode::Stop()
{
   LOG_DEBUG() << "Node Stopping";
   for (auto &p : sockets_) { p->Stop(); }
   LOG_INFO() << "Node Stopped";
}
bool TopicNode::Register(ProcInfo &proc, MsgCommonReply &reply_body, const int timeout_ms)
bool TopicNode::DoRegister(const bool internal, ProcInfo &proc, MsgCommonReply &reply_body, const int timeout_ms)
{
   if (!internal && !ValidUserSymbol(proc.proc_id())) {
      SetLastError(eInvalidInput, "invalid proc id :'" + proc.proc_id() + "'");
      return false;
   }
   {
      std::lock_guard<std::mutex> lk(mutex_);
      info_ = proc;
@@ -167,19 +164,22 @@
      SetLastError(eError, kErrMsgNotInit);
      return false;
   }
   auto end_time = steady_clock::now() + milliseconds(timeout_ms);
   while (!Valid() && steady_clock::now() < end_time) {
      std::this_thread::yield();
   }
   if (!Valid()) {
      SetLastError(eError, kErrMsgNotInit);
      return false;
   }
   auto &sock = SockNode();
   MsgRegister body;
   body.mutable_proc()->Swap(&proc);
   auto AddId = [&](const MQId id) { body.add_addrs()->set_mq_id(id); };
   AddId(SockNode().id());
   AddId(SockServer().id());
   AddId(SockClient().id());
   AddId(SockSub().id());
   AddId(SockPub().id());
   auto head(InitMsgHead(GetType(body), body.proc().proc_id(), ssn()));
   AddRoute(head, sock.id());
   AddRoute(head, sock);
   auto CheckResult = [this](MsgI &msg, BHMsgHead &head, MsgCommonReply &rbody) {
      bool ok = head.type() == kMsgTypeCommonReply &&
@@ -197,12 +197,12 @@
         MsgCommonReply body;
         CheckResult(imsg, head, body);
      };
      return sock.Send(BHTopicCenterAddress(), head, body, onResult);
      return sock.Send(CenterAddr(), head, body, onResult);
   } else {
      MsgI reply;
      MsgI reply(shm());
      DEFER1(reply.Release(););
      BHMsgHead reply_head;
      bool r = sock.SendAndRecv(BHTopicCenterAddress(), head, body, reply, reply_head, timeout_ms);
      bool r = sock.SendAndRecv(CenterAddr(), head, body, reply, reply_head, timeout_ms);
      if (r) {
         CheckResult(reply, reply_head, reply_body);
      }
@@ -224,7 +224,7 @@
   body.mutable_proc()->Swap(&proc);
   auto head(InitMsgHead(GetType(body), body.proc().proc_id(), ssn()));
   AddRoute(head, sock.id());
   AddRoute(head, sock);
   auto CheckResult = [this](MsgI &msg, BHMsgHead &head, MsgCommonReply &rbody) {
      bool r = head.type() == kMsgTypeCommonReply &&
@@ -238,12 +238,12 @@
         MsgCommonReply body;
         CheckResult(imsg, head, body);
      };
      return sock.Send(BHTopicCenterAddress(), head, body, onResult);
      return sock.Send(CenterAddr(), head, body, onResult);
   } else {
      MsgI reply;
      MsgI reply(shm());
      DEFER1(reply.Release(););
      BHMsgHead reply_head;
      bool r = sock.SendAndRecv(BHTopicCenterAddress(), head, body, reply, reply_head, timeout_ms);
      bool r = sock.SendAndRecv(CenterAddr(), head, body, reply, reply_head, timeout_ms);
      return r && CheckResult(reply, reply_head, reply_body);
   }
}
@@ -260,15 +260,15 @@
   body.mutable_proc()->Swap(&proc);
   auto head(InitMsgHead(GetType(body), body.proc().proc_id(), ssn()));
   AddRoute(head, sock.id());
   AddRoute(head, sock);
   if (timeout_ms == 0) {
      return sock.Send(BHTopicCenterAddress(), head, body);
      return sock.Send(CenterAddr(), head, body);
   } else {
      MsgI reply;
      MsgI reply(shm());
      DEFER1(reply.Release(););
      BHMsgHead reply_head;
      bool r = sock.SendAndRecv(BHTopicCenterAddress(), head, body, reply, reply_head, timeout_ms);
      bool r = sock.SendAndRecv(CenterAddr(), head, body, reply, reply_head, timeout_ms);
      r = r && reply_head.type() == kMsgTypeCommonReply && reply.ParseBody(reply_body);
      return (r && IsSuccess(reply_body.errmsg().errcode()));
   }
@@ -290,18 +290,46 @@
   auto &sock = SockNode();
   BHMsgHead head(InitMsgHead(GetType(query), proc_id(), ssn()));
   AddRoute(head, sock.id());
   AddRoute(head, sock);
   MsgI reply;
   MsgI reply(shm());
   DEFER1(reply.Release());
   BHMsgHead reply_head;
   return (sock.SendAndRecv(BHTopicCenterAddress(), head, query, reply, reply_head, timeout_ms) &&
   return (sock.SendAndRecv(CenterAddr(), head, query, reply, reply_head, timeout_ms) &&
           reply_head.type() == kMsgTypeQueryTopicReply &&
           reply.ParseBody(reply_body));
}
bool TopicNode::ServerRegisterRPC(MsgTopicList &topics, MsgCommonReply &reply_body, const int timeout_ms)
bool TopicNode::QueryProcs(BHAddress &dest, MsgQueryProc &query, MsgQueryProcReply &reply_body, const int timeout_ms)
{
   if (!IsOnline()) {
      SetLastError(eNotRegistered, kErrMsgNotRegistered);
      return false;
   }
   auto &sock = SockNode();
   BHMsgHead head(InitMsgHead(GetType(query), proc_id(), ssn()));
   AddRoute(head, sock);
   MsgI reply(shm());
   DEFER1(reply.Release());
   BHMsgHead reply_head;
   return (sock.SendAndRecv(CenterAddr(), head, query, reply, reply_head, timeout_ms) &&
           reply_head.type() == kMsgTypeQueryProcReply &&
           reply.ParseBody(reply_body));
}
bool TopicNode::DoServerRegisterRPC(const bool internal, MsgTopicList &topics, MsgCommonReply &reply_body, const int timeout_ms)
{
   if (!internal) {
      for (auto &&topic : topics.topic_list()) {
         if (!ValidUserSymbol(topic)) {
            SetLastError(eInvalidInput, "invalid user topic :'" + topic + "'");
            return false;
         }
      }
   }
   if (!IsOnline()) {
      SetLastError(eNotRegistered, kErrMsgNotRegistered);
      return false;
@@ -312,15 +340,15 @@
   body.mutable_topics()->Swap(&topics);
   auto head(InitMsgHead(GetType(body), proc_id(), ssn()));
   AddRoute(head, sock.id());
   AddRoute(head, sock);
   if (timeout_ms == 0) {
      return sock.Send(BHTopicCenterAddress(), head, body);
      return sock.Send(CenterAddr(), head, body);
   } else {
      MsgI reply;
      MsgI reply(shm());
      DEFER1(reply.Release(););
      BHMsgHead reply_head;
      bool r = sock.SendAndRecv(BHTopicCenterAddress(), head, body, reply, reply_head, timeout_ms);
      bool r = sock.SendAndRecv(CenterAddr(), head, body, reply, reply_head, timeout_ms);
      r = r && reply_head.type() == kMsgTypeCommonReply;
      r = r && reply.ParseBody(reply_body);
      return r;
@@ -341,7 +369,7 @@
         for (int i = 0; i < head.route_size() - 1; ++i) {
            reply_head.add_route()->Swap(head.mutable_route(i));
         }
         auto remote = head.route().rbegin()->mq_id();
         MQInfo remote = {head.route().rbegin()->mq_id(), head.route().rbegin()->abs_addr()};
         sock.Send(remote, reply_head, reply_body);
      }
   };
@@ -352,19 +380,32 @@
bool TopicNode::ServerStart(const ServerAsyncCB &acb, int nworker)
{
   auto onRecv = [this, acb](ShmSocket &sock, MsgI &imsg, BHMsgHead &head) {
      if (head.type() != kMsgTypeRequestTopic || head.route_size() == 0) { return; }
      MsgRequestTopic req;
      if (!imsg.ParseBody(req)) { return; }
   if (acb) {
      auto onRecv = [this, acb](ShmSocket &sock, MsgI &imsg, BHMsgHead &head) {
         if (head.type() != kMsgTypeRequestTopic || head.route_size() == 0) { return; }
         MsgRequestTopic req;
         if (!imsg.ParseBody(req)) { return; }
      SrcInfo *p = new SrcInfo;
      p->route.assign(head.route().begin(), head.route().end());
      p->msg_id = head.msg_id();
      acb(p, *head.mutable_proc_id(), req);
   };
         try {
            SrcInfo *p = new SrcInfo;
            if (!p) {
               throw std::runtime_error("no memory.");
            }
            p->route.assign(head.route().begin(), head.route().end());
            p->msg_id = head.msg_id();
            acb(p, *head.mutable_proc_id(), req);
         } catch (std::exception &e) {
            LOG_ERROR() << "error server handle msg:" << e.what();
         }
      };
   auto &sock = SockServer();
   return acb && sock.Start(onRecv, nworker);
      return SockServer().Start(onRecv, nworker);
   } else {
      auto onRequest = [this](ShmSocket &socket, MsgI &msg, BHMsgHead &head) {
         server_buffer_->Write(std::move(head), msg.body());
      };
      return SockServer().Start(onRequest, nworker);
   }
}
bool TopicNode::ServerRecvRequest(void *&src_info, std::string &proc_id, MsgRequestTopic &request, const int timeout_ms)
@@ -373,19 +414,34 @@
      SetLastError(eNotRegistered, kErrMsgNotRegistered);
      return false;
   }
   auto &sock = SockServer();
   MsgI imsg;
   BHMsgHead head;
   if (sock.SyncRecv(imsg, head, timeout_ms) && head.type() == kMsgTypeRequestTopic) {
      if (imsg.ParseBody(request)) {
   std::string body;
   FibUSleeper sleeper(1000 * 10);
   auto end_time = steady_clock::now() + milliseconds(timeout_ms);
   while (!server_buffer_->Read(head, body)) {
      if (steady_clock::now() < end_time) {
         sleeper.Sleep();
      } else {
         return false;
      }
   }
   if (head.type() == kMsgTypeRequestTopic) {
      if (request.ParseFromString(body)) {
         head.mutable_proc_id()->swap(proc_id);
         SrcInfo *p = new SrcInfo;
         p->route.assign(head.route().begin(), head.route().end());
         p->msg_id = head.msg_id();
         src_info = p;
         return true;
         try {
            SrcInfo *p = new SrcInfo;
            if (!p) {
               throw std::runtime_error("no memory.");
            }
            p->route.assign(head.route().begin(), head.route().end());
            p->msg_id = head.msg_id();
            src_info = p;
            return true;
         } catch (std::exception &e) {
            LOG_ERROR() << "error recv request: " << e.what();
            return false;
         }
      }
   }
   return false;
@@ -409,7 +465,8 @@
   for (unsigned i = 0; i < p->route.size() - 1; ++i) {
      head.add_route()->Swap(&p->route[i]);
   }
   return sock.Send(p->route.back().mq_id(), head, body);
   MQInfo dest = {p->route.back().mq_id(), p->route.back().abs_addr()};
   return sock.Send(dest, head, body);
}
bool TopicNode::ClientStartWorker(RequestResultCB const &cb, const int nworker)
@@ -440,10 +497,10 @@
   out_msg_id = msg_id;
   auto SendTo = [this, msg_id](const BHAddress &addr, const MsgRequestTopic &req, const RequestResultCB &cb) {
   auto SendTo = [this, msg_id](const MQInfo &remote, const MsgRequestTopic &req, const RequestResultCB &cb) {
      auto &sock = SockClient();
      BHMsgHead head(InitMsgHead(GetType(req), proc_id(), ssn(), msg_id));
      AddRoute(head, sock.id());
      AddRoute(head, sock);
      head.set_topic(req.topic());
      if (cb) {
@@ -455,15 +512,15 @@
               }
            }
         };
         return sock.Send(addr.mq_id(), head, req, onRecv);
         return sock.Send(remote, head, req, onRecv);
      } else {
         return sock.Send(addr.mq_id(), head, req);
         return sock.Send(remote, head, req);
      }
   };
   try {
      BHAddress addr;
      return (ClientQueryRPCTopic(req.topic(), addr, 3000)) && SendTo(addr, req, cb);
      return (ClientQueryRPCTopic(req.topic(), addr, 3000)) && SendTo(MQInfo{addr.mq_id(), addr.abs_addr()}, req, cb);
   } catch (...) {
      SetLastError(eError, "internal error.");
      return false;
@@ -484,14 +541,14 @@
      if (ClientQueryRPCTopic(request.topic(), addr, timeout_ms)) {
         LOG_TRACE() << "node: " << SockNode().id() << ", topic dest: " << addr.mq_id();
         BHMsgHead head(InitMsgHead(GetType(request), proc_id(), ssn()));
         AddRoute(head, sock.id());
         AddRoute(head, sock);
         head.set_topic(request.topic());
         MsgI reply_msg;
         MsgI reply_msg(shm());
         DEFER1(reply_msg.Release(););
         BHMsgHead reply_head;
         if (sock.SendAndRecv(addr.mq_id(), head, request, reply_msg, reply_head, timeout_ms) &&
         if (sock.SendAndRecv({addr.mq_id(), addr.abs_addr()}, head, request, reply_msg, reply_head, timeout_ms) &&
             reply_head.type() == kMsgTypeRequestTopicReply &&
             reply_msg.ParseBody(out_reply)) {
            reply_head.mutable_proc_id()->swap(out_proc_id);
@@ -504,7 +561,7 @@
   return false;
}
int TopicNode::QueryRPCTopics(const Topic &topic, std::vector<NodeAddress> &addr, const int timeout_ms)
int TopicNode::QueryTopicServers(const Topic &topic, std::vector<NodeAddress> &addr, const int timeout_ms)
{
   int n = 0;
   MsgQueryTopic query;
@@ -532,7 +589,7 @@
      return true;
   }
   std::vector<NodeAddress> lst;
   if (QueryRPCTopics(topic, lst, timeout_ms)) {
   if (QueryTopicServers(topic, lst, timeout_ms)) {
      addr = lst.front().addr();
      if (addr.mq_id() != 0) {
         topic_query_cache_.Store(topic, addr);
@@ -555,16 +612,16 @@
   try {
      auto &sock = SockPub();
      BHMsgHead head(InitMsgHead(GetType(pub), proc_id(), ssn()));
      AddRoute(head, sock.id());
      AddRoute(head, sock);
      if (timeout_ms == 0) {
         return sock.Send(BHTopicBusAddress(), head, pub);
         return sock.Send(BusAddr(), head, pub);
      } else {
         MsgI reply;
         MsgI reply(shm());
         DEFER1(reply.Release(););
         BHMsgHead reply_head;
         MsgCommonReply reply_body;
         return sock.SendAndRecv(BHTopicBusAddress(), head, pub, reply, reply_head, timeout_ms) &&
         return sock.SendAndRecv(BusAddr(), head, pub, reply, reply_head, timeout_ms) &&
                reply_head.type() == kMsgTypeCommonReply &&
                reply.ParseBody(reply_body) &&
                IsSuccess(reply_body.errmsg().errcode());
@@ -589,14 +646,14 @@
      sub.mutable_topics()->Swap(&topics);
      BHMsgHead head(InitMsgHead(GetType(sub), proc_id(), ssn()));
      AddRoute(head, sock.id());
      AddRoute(head, sock);
      if (timeout_ms == 0) {
         return sock.Send(BHTopicBusAddress(), head, sub);
         return sock.Send(BusAddr(), head, sub);
      } else {
         MsgI reply;
         MsgI reply(shm());
         DEFER1(reply.Release(););
         BHMsgHead reply_head;
         return sock.SendAndRecv(BHTopicBusAddress(), head, sub, reply, reply_head, timeout_ms) &&
         return sock.SendAndRecv(BusAddr(), head, sub, reply, reply_head, timeout_ms) &&
                reply_head.type() == kMsgTypeCommonReply &&
                reply.ParseBody(reply_body) &&
                IsSuccess(reply_body.errmsg().errcode());
@@ -609,20 +666,24 @@
bool TopicNode::SubscribeStartWorker(const SubDataCB &tdcb, int nworker)
{
   auto &sock = SockSub();
   auto AsyncRecvProc = [this, tdcb](ShmSocket &, MsgI &imsg, BHMsgHead &head) {
      if (head.type() == kMsgTypePublish) {
         MsgPublish pub;
         if (imsg.ParseBody(pub)) {
            tdcb(head.proc_id(), pub);
   if (tdcb) {
      auto AsyncRecvProc = [this, tdcb](ShmSocket &, MsgI &imsg, BHMsgHead &head) {
         if (head.type() == kMsgTypePublish) {
            MsgPublish pub;
            if (imsg.ParseBody(pub)) {
               tdcb(head.proc_id(), pub);
            }
         } else {
            // ignored, or dropped
         }
      } else {
         // ignored, or dropped
      }
   };
   return tdcb && sock.Start(AsyncRecvProc, nworker);
      };
      return SockSub().Start(AsyncRecvProc, nworker);
   } else {
      auto onSub = [this](ShmSocket &socket, MsgI &msg, BHMsgHead &head) {
         sub_buffer_->Write(std::move(head), msg.body());
      };
      return SockSub().Start(onSub, nworker);
   }
}
bool TopicNode::RecvSub(std::string &proc_id, MsgPublish &pub, const int timeout_ms)
@@ -632,13 +693,20 @@
      return false;
   }
   auto &sock = SockSub();
   MsgI msg;
   DEFER1(msg.Release(););
   BHMsgHead head;
   std::string body;
   FibUSleeper sleeper(1000 * 10);
   auto end_time = steady_clock::now() + milliseconds(timeout_ms);
   while (!sub_buffer_->Read(head, body)) {
      if (steady_clock::now() < end_time) {
         sleeper.Sleep();
      } else {
         return false;
      }
   }
   //TODO error msg.
   if (sock.SyncRecv(msg, head, timeout_ms) && head.type() == kMsgTypePublish) {
      if (msg.ParseBody(pub)) {
   if (head.type() == kMsgTypePublish) {
      if (pub.ParseFromString(body)) {
         head.mutable_proc_id()->swap(proc_id);
         return true;
      }