lichao
2021-04-12 1b52f1cb8c47dd2c0195d2fd65d7b6a4c2f10704
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
/*
 * =====================================================================================
 *
 *       Filename:  socket.cpp
 *
 *    Description:  
 *
 *        Version:  1.0
 *        Created:  2021年03月30日 15时48分58秒
 *       Revision:  none
 *       Compiler:  gcc
 *
 *         Author:  Li Chao (), 
 *   Organization:  
 *
 * =====================================================================================
 */
 
#include "socket.h"
#include "bh_util.h"
#include "defs.h"
#include "msg.h"
 
using namespace bhome_msg;
using namespace bhome_shm;
 
namespace
{
 
} // namespace
 
ShmSocket::ShmSocket(Shm &shm, const MQId &id, const int len) :
    shm_(shm), run_(false), mq_(id, shm, len)
{
}
ShmSocket::ShmSocket(bhome_shm::SharedMemory &shm, const int len) :
    shm_(shm), run_(false), mq_(shm, len) {}
 
ShmSocket::~ShmSocket()
{
    Stop(); //TODO should stop in sub class, incase thread access sub class data.
}
 
bool ShmSocket::Start(int nworker, const RecvCB &onData, const IdleCB &onIdle)
{
    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);
        } else { // else ignored, or dropped
        }
    };
 
    auto recvLoopBody = [this, onRecvWithPerMsgCB, onIdle]() {
        try {
            MsgI imsg;
            if (mq().Recv(imsg, 10)) {
                DEFER1(imsg.Release(shm()));
                BHMsgHead head;
                if (imsg.ParseHead(head)) {
                    onRecvWithPerMsgCB(*this, imsg, head);
                }
            }
            if (onIdle) {
                onIdle(*this);
            }
        } catch (...) {
        }
    };
 
    std::lock_guard<std::mutex> lock(mutex_);
    StopNoLock();
 
    run_.store(true);
    for (int i = 0; i < nworker; ++i) {
        workers_.emplace_back([this, recvLoopBody]() { while (run_) { recvLoopBody(); } });
    }
    return true;
}
 
bool ShmSocket::Stop()
{
    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();
            }
        }
        workers_.clear();
        return true;
    }
    return false;
}
 
bool ShmSocket::SyncRecv(bhome_msg::MsgI &msg, bhome::msg::BHMsgHead &head, const int timeout_ms)
{
    std::lock_guard<std::mutex> lock(mutex_);
    auto Recv = [&]() {
        if (mq().Recv(msg, timeout_ms)) {
            if (msg.ParseHead(head)) {
                return true;
            } else {
                msg.Release(shm());
            }
        }
        return false;
    };
    return !RunningNoLock() && Recv();
}