lichao
2021-04-01 d26327b3cde043a9470dcd7fea8e704ea517fdae
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
/*
 * =====================================================================================
 *
 *       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 void *id, const int len) :
    shm_(shm), run_(false)
{
    if (id && len > 0) {
        mq_.reset(new Queue(*static_cast<const MQId *>(id), shm, len));
    }
}
ShmSocket::ShmSocket(bhome_shm::SharedMemory &shm, const int len) :
    shm_(shm), run_(false)
{
    if (len > 0) {
        mq_.reset(new Queue(shm_, len));
    }
}
 
ShmSocket::~ShmSocket()
{
    Stop(); //TODO should stop in sub class, incase thread access sub class data.
}
 
bool ShmSocket::StartRaw(const RecvRawCB &onData, int nworker)
{
    if (!mq_) {
        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::Start(const RecvCB &onData, int nworker)
{
    return StartRaw([this, onData](MsgI &imsg) { BHMsg m; if (imsg.Unpack(m)) { onData(m); } }, nworker);
}
 
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::SyncSend(const void *id, const bhome_msg::BHMsg &msg, const int timeout_ms)
{
    return mq_->Send(*static_cast<const MQId *>(id), msg, timeout_ms);
}
 
bool ShmSocket::SyncRecv(bhome_msg::BHMsg &msg, const int timeout_ms)
{
    std::lock_guard<std::mutex> lock(mutex_);
    if (!mq_ || RunningNoLock()) {
        return false;
    } else {
        return mq_->Recv(msg, timeout_ms);
    }
}