lichao
2021-04-08 c338820e4db43ad32c20ff429a038b06bcb980f8
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
118
119
120
121
122
123
124
125
126
127
128
129
/*
 * =====================================================================================
 *
 *       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 onRecv = [this, onData](ShmSocket &socket, MsgI &imsg, BHMsgHead &head) {
        auto Find = [&](RecvCB &cb) {
            std::lock_guard<std::mutex> lock(mutex());
            const std::string &msgid = head.msg_id();
            auto pos = async_cbs_.find(msgid);
            if (pos != async_cbs_.end()) {
                cb.swap(pos->second);
                async_cbs_.erase(pos);
                return true;
            } else {
                return false;
            }
        };
 
        RecvCB cb;
        if (Find(cb)) {
            cb(socket, imsg, head);
        } else if (onData) {
            onData(socket, imsg, head);
        } // else ignored, or dropped
    };
 
    std::lock_guard<std::mutex> lock(mutex_);
    StopNoLock();
    auto RecvProc = [this, onRecv, onIdle]() {
        while (run_) {
            try {
                MsgI imsg;
                if (mq().Recv(imsg, 10)) {
                    DEFER1(imsg.Release(shm()));
                    BHMsgHead head;
                    if (imsg.ParseHead(head)) {
                        onRecv(*this, imsg, head);
                    }
                } else if (onIdle) {
                    onIdle(*this);
                }
            } catch (...) {
            }
        }
    };
 
    run_.store(true);
    for (int i = 0; i < nworker; ++i) {
        workers_.emplace_back(RecvProc);
    }
    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();
}