GCC Code Coverage Report

Directory: ./
File: pdserv/src/msrproto/SubscriptionManager.cpp
Date: 2023-11-12 04:06:57
Exec Total Coverage
Lines: 88 146 60.3%
Branches: 69 180 38.3%
Line Branch Exec Source
1 /*****************************************************************************
2 *
3 * $Id$
4 *
5 * Copyright 2010 Richard Hacker (lerichi at gmx dot net)
6 *
7 * This file is part of the pdserv library.
8 *
9 * The pdserv library is free software: you can redistribute it and/or modify
10 * it under the terms of the GNU Lesser General Public License as published
11 * by the Free Software Foundation, either version 3 of the License, or (at
12 * your option) any later version.
13 *
14 * The pdserv library is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
16 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public
17 * License for more details.
18 *
19 * You should have received a copy of the GNU Lesser General Public License
20 * along with the pdserv library. If not, see <http://www.gnu.org/licenses/>.
21 *
22 *****************************************************************************/
23
24 #include "../Debug.h"
25 #include "../Main.h"
26 #include "../Signal.h"
27 #include "../Task.h"
28 #include "../TaskStatistics.h"
29 #include "SubscriptionManager.h"
30 #include "Channel.h"
31 #include "Session.h"
32 #include "Subscription.h"
33
34 using namespace MsrProto;
35
36 /////////////////////////////////////////////////////////////////////////////
37 struct timespec SubscriptionManager::dummyTime;
38 PdServ::TaskStatistics SubscriptionManager::dummyTaskStatistics;
39
40 /////////////////////////////////////////////////////////////////////////////
41 248 SubscriptionManager::SubscriptionManager(
42 248 Session *s, const PdServ::Task* task):
43 248 SessionTask(task), session(s)
44 {
45 248 taskTime = &dummyTime;
46 248 taskStatistics = &dummyTaskStatistics;
47
48 // Call rxPdo() once so that taskTime and taskStatistics are updated
49
1/2
✓ Branch 6 taken 248 times.
✗ Branch 7 not taken.
 248 task->rxPdo(this, &taskTime, &taskStatistics);
50 248 }
51
52 /////////////////////////////////////////////////////////////////////////////
53 744 SubscriptionManager::~SubscriptionManager()
54 {
55 248 clear();
56 496 }
57
58 /////////////////////////////////////////////////////////////////////////////
59 12 void SubscriptionManager::subscribe (const Channel *c, size_t group,
60 size_t decimation, size_t blocksize, bool base64,
61 std::streamsize precision)
62 {
63 12 Subscription** s = &signalSubscriptionMap[c->signal][c][group];
64
65 // First remove possible subscription. It doesn't matter if it is null
66
1/2
✗ Branch 1 not taken.
✓ Branch 2 taken 12 times.
 12 if (*s)
67 ✗ remove(*s, group);
68
69
1/2
✓ Branch 3 taken 12 times.
✗ Branch 4 not taken.
 12 *s = new Subscription(c, decimation, blocksize, base64, precision);
70
71 // Call subscribe on this signal. It doesn't matter if it is already
72 // subscribed, but it is useful because newSignal() is called for us
73 // in this special case
74 12 c->signal->subscribe(this);
75 12 }
76
77 /////////////////////////////////////////////////////////////////////////////
78 ✗ void SubscriptionManager::unsubscribe(const Channel *c, size_t group)
79 {
80 // Go through all groups (signal, channel, group) to find the signal,
81 // keeping in mind that the channel may not even be subscribed yet!
82
83 ✗ SignalSubscriptionMap::iterator sit = signalSubscriptionMap.find(c->signal);
84 ✗ if (sit == signalSubscriptionMap.end())
85 ✗ return;
86
87 ✗ ChannelSubscriptionMap::iterator cit = sit->second.find(c);
88 ✗ if (cit == sit->second.end())
89 ✗ return;
90
91 ✗ SubscriptionGroup::iterator git = cit->second.find(group);
92 ✗ if (git == cit->second.end())
93 ✗ return;
94
95 // Remove channel from active list
96 ✗ remove(git->second, group);
97
98 // Now that the channel is unsubscribed, check for empty groups,
99 // jumping out if the group is not empty
100
101 ✗ cit->second.erase(git);
102 ✗ if (!cit->second.empty())
103 ✗ return;
104
105 ✗ sit->second.erase(cit);
106 ✗ if (!sit->second.empty())
107 ✗ return;
108
109 // Don't require signal any more
110 ✗ signalSubscriptionMap.erase(sit);
111 ✗ c->signal->unsubscribe(this);
112 }
113
114 /////////////////////////////////////////////////////////////////////////////
115 248 void SubscriptionManager::clear()
116 {
117 496 SignalSubscriptionMap::const_iterator sit;
118 496 ChannelSubscriptionMap::const_iterator cit;
119 496 SubscriptionGroup::const_iterator git;
120
121 248 activeSignals.clear();
122
123 260 for (sit = signalSubscriptionMap.begin();
124
2/2
✓ Branch 6 taken 12 times.
✓ Branch 7 taken 248 times.
 260 sit != signalSubscriptionMap.end(); ++sit) {
125
2/2
✓ Branch 14 taken 12 times.
✓ Branch 15 taken 12 times.
 24 for (cit = sit->second.begin(); cit != sit->second.end(); ++cit) {
126
1/2
✓ Branch 8 taken 12 times.
✗ Branch 9 not taken.
 12 sit->first->unsubscribe(this);
127
2/2
✓ Branch 14 taken 12 times.
✓ Branch 15 taken 12 times.
 24 for (git = cit->second.begin(); git != cit->second.end(); ++git)
128
1/2
✓ Branch 2 taken 12 times.
✗ Branch 3 not taken.
 12 delete git->second;
129 }
130 }
131
132 248 signalSubscriptionMap.clear();
133 248 }
134
135 /////////////////////////////////////////////////////////////////////////////
136 12 void SubscriptionManager::newSignal( const PdServ::Signal *s)
137 {
138
2/4
✓ Branch 3 taken 12 times.
✗ Branch 4 not taken.
✓ Branch 10 taken 12 times.
✗ Branch 11 not taken.
 24 SignalSubscriptionMap::const_iterator sit = signalSubscriptionMap.find(s);
139
140 // Find out whether this signal is used or whether sit is active already
141
1/2
✗ Branch 6 not taken.
✓ Branch 7 taken 12 times.
 12 if (sit == signalSubscriptionMap.end())
142 ✗ return;
143
144
1/2
✓ Branch 7 taken 12 times.
✗ Branch 8 not taken.
 24 for (ChannelSubscriptionMap::const_iterator cit = sit->second.begin();
145
2/2
✓ Branch 7 taken 12 times.
✓ Branch 8 taken 12 times.
 24 cit != sit->second.end(); ++cit) {
146 24 for (SubscriptionGroup::const_iterator git = cit->second.begin();
147
2/2
✓ Branch 7 taken 12 times.
✓ Branch 8 taken 12 times.
 24 git != cit->second.end(); ++git) {
148
149 12 Subscription* s = git->second;
150
151 // Put subscription into active list
152 // Note: for event subscriptions, blocksize == 0
153 SubscriptionSet* g =
154
3/6
✓ Branch 6 taken 12 times.
✗ Branch 7 not taken.
✓ Branch 10 taken 12 times.
✗ Branch 11 not taken.
✓ Branch 14 taken 12 times.
✗ Branch 15 not taken.
 12 &activeSignals[git->first][s->decimation][s->blocksize];
155
156
1/2
✓ Branch 2 taken 12 times.
✗ Branch 3 not taken.
 12 if (g->empty()) {
157 // The blocksize group jas just been created, add data space for
158 // current time
159
2/4
✓ Branch 3 taken 12 times.
✗ Branch 4 not taken.
✓ Branch 9 taken 12 times.
✗ Branch 10 not taken.
 12 g->time.reset(new uint64_t[s->blocksize + !s->blocksize]);
160 12 g->timePtr = g->time.get();
161 log_debug("s=%zu %zu:%zu:%zu %p", s->blocksize,
162 git->first, s->decimation, s->blocksize, g->time);
163 }
164
165
1/2
✓ Branch 2 taken 12 times.
✗ Branch 3 not taken.
 12 g->insert(s);
166 }
167 }
168 }
169
170 /////////////////////////////////////////////////////////////////////////////
171 ✗ void SubscriptionManager::remove (Subscription *s, size_t group)
172 {
173 // Find the map for the group
174 ✗ ActiveSignals::iterator git = activeSignals.find(group);
175 ✗ if (git == activeSignals.end())
176 ✗ return;
177
178 // Find the decimation group
179 ✗ DecimationGroup::iterator dit = git->second.find(s->decimation);
180 ✗ if (dit == git->second.end())
181 ✗ return;
182
183 // Find the blocksize group
184 ✗ BlocksizeGroup::iterator bit = dit->second.find(s->blocksize);
185 ✗ if (bit == dit->second.end())
186 ✗ return;
187
188 // Delete and remove subscription from set
189 ✗ delete s;
190 ✗ bit->second.erase(s);
191 ✗ if (!bit->second.empty())
192 ✗ return;
193
194 // blocksize group is empty, erase it
195 ✗ dit->second.erase(bit);
196 ✗ if (!dit->second.empty())
197 ✗ return;
198
199 // decimation group is empty, erase it
200 ✗ git->second.erase(dit);
201 ✗ if (!git->second.empty())
202 ✗ return;
203
204 // group is emty, erase it
205 ✗ activeSignals.erase(git);
206 }
207
208 /////////////////////////////////////////////////////////////////////////////
209 12762 void SubscriptionManager::rxPdo(bool quiet)
210 {
211 25524 ActiveSignals::iterator git;
212 25524 DecimationGroup::iterator dit;
213 25524 BlocksizeGroup::iterator bit;
214 25524 SubscriptionSet::iterator sit;
215 Subscription* s;
216 12762 Subscription* printQ, **printQEnd;
217 bool print;
218
219
3/4
✓ Branch 24 taken 14270 times.
✗ Branch 25 not taken.
✓ Branch 26 taken 1508 times.
✓ Branch 27 taken 12762 times.
 15778 while (task->rxPdo(this, &taskTime, &taskStatistics)) {
220
1/2
✗ Branch 0 not taken.
✓ Branch 1 taken 1508 times.
 1508 if (quiet)
221 ✗ continue;
222
223 // Go through all groups
224
2/2
✓ Branch 12 taken 487 times.
✓ Branch 13 taken 1508 times.
 1995 for (git = activeSignals.begin(); git != activeSignals.end(); ++git) {
225
226 // Go through all decimations
227
2/2
✓ Branch 14 taken 487 times.
✓ Branch 15 taken 487 times.
 974 for (dit = git->second.begin(); dit != git->second.end(); ++dit) {
228
229 // Check decimation counter
230
2/2
✓ Branch 5 taken 422 times.
✓ Branch 6 taken 65 times.
 487 if (dit->second.busy(dit->first))
231 422 continue;
232
233 // Go through all blocksizes
234 130 for (bit = dit->second.begin();
235
2/2
✓ Branch 7 taken 65 times.
✓ Branch 8 taken 65 times.
 130 bit != dit->second.end(); ++bit) {
236
237 // Capture time
238 130 *bit->second.timePtr =
239 130 1000000000ULL * taskTime->tv_sec + taskTime->tv_nsec;
240
241 // For non-event groups, increment timePtr and check
242 // whether it points to the end
243 65 print = false;
244
2/2
✓ Branch 2 taken 53 times.
✓ Branch 3 taken 12 times.
 65 if (bit->first) {
245 53 ++bit->second.timePtr;
246 106 print = (bit->second.time.get() + bit->first)
247 53 == bit->second.timePtr;
248 }
249
250 // Prepare print queue
251 65 printQ = 0;
252 65 printQEnd = &printQ;
253
254 // Go through all subscriptions
255 130 for (sit = bit->second.begin();
256
2/2
✓ Branch 7 taken 65 times.
✓ Branch 8 taken 65 times.
 130 sit != bit->second.end(); ++sit) {
257 65 s = *sit;
258
1/2
✓ Branch 25 taken 65 times.
✗ Branch 26 not taken.
 65 const char *data = s->channel->signal->getValue(this);
259
260
9/10
✓ Branch 2 taken 65 times.
✗ Branch 3 not taken.
✓ Branch 4 taken 55 times.
✓ Branch 5 taken 10 times.
✓ Branch 8 taken 53 times.
✓ Branch 9 taken 2 times.
✓ Branch 10 taken 47 times.
✓ Branch 11 taken 16 times.
✓ Branch 12 taken 49 times.
✓ Branch 13 taken 16 times.
 65 if ((s->newValue(data) and !bit->first) or print) {
261 49 *printQEnd = s;
262 49 printQEnd = &s->next;
263 49 s->next = 0; // Sentinel
264 }
265 }
266
267 // Check if any signals need printing
268
2/2
✓ Branch 0 taken 49 times.
✓ Branch 1 taken 16 times.
 65 if (printQ) {
269
1/2
✓ Branch 5 taken 49 times.
✗ Branch 6 not taken.
 98 XmlElement dataTag(session->createElement("data"));
270
2/2
✓ Branch 2 taken 47 times.
✓ Branch 3 taken 2 times.
 49 if (git->first)
271
1/2
✓ Branch 1 taken 47 times.
✗ Branch 2 not taken.
 94 XmlElement::Attribute(dataTag, "group")
272
1/2
✓ Branch 5 taken 47 times.
✗ Branch 6 not taken.
 94 << git->first;
273
274
2/4
✓ Branch 2 taken 49 times.
✗ Branch 3 not taken.
✓ Branch 8 taken 49 times.
✗ Branch 9 not taken.
 49 XmlElement::Attribute(dataTag, "level") << 0;
275
2/4
✓ Branch 2 taken 49 times.
✗ Branch 3 not taken.
✓ Branch 10 taken 49 times.
✗ Branch 11 not taken.
 49 XmlElement::Attribute(dataTag, "time") << *taskTime;
276
277 // Print time channel
278 {
279 size_t len = sizeof(uint64_t)
280 49 * (bit->first + !bit->first);
281
282
1/2
✓ Branch 2 taken 49 times.
✗ Branch 3 not taken.
 98 XmlElement time(dataTag.createChild("time"));
283
1/2
✓ Branch 2 taken 49 times.
✗ Branch 3 not taken.
 98 XmlElement::Attribute value(time, "d");
284
1/2
✓ Branch 4 taken 49 times.
✗ Branch 5 not taken.
 49 value.base64(bit->second.time.get(), len);
285 }
286
287 // Reset timePtr
288 49 bit->second.timePtr = bit->second.time.get();
289
290 // Print every subscription
291
2/2
✓ Branch 0 taken 49 times.
✓ Branch 1 taken 49 times.
 98 for (s = printQ; s; s = s->next)
292
1/2
✓ Branch 2 taken 49 times.
✗ Branch 3 not taken.
 49 s->print(dataTag);
293 }
294 }
295 }
296 }
297 }
298 12762 }
299
300 /////////////////////////////////////////////////////////////////////////////
301 ✗ void SubscriptionManager::sync()
302 {
303 ✗ ActiveSignals::iterator git;
304 ✗ DecimationGroup::iterator dit;
305 ✗ BlocksizeGroup::iterator bit;
306 ✗ SubscriptionSet::iterator sit;
307
308 ✗ for (git = activeSignals.begin();
309 ✗ git != activeSignals.end(); ++git) {
310 ✗ for (dit = git->second.begin();
311 ✗ dit != git->second.end(); ++dit) {
312 ✗ for (bit = dit->second.begin();
313 ✗ bit != dit->second.end(); ++bit) {
314 ✗ bit->second.timePtr = bit->second.time.get();
315 ✗ for (sit = bit->second.begin();
316 ✗ sit != bit->second.end(); ++sit)
317 ✗ (*sit)->reset();
318 }
319 }
320 }
321 }
322