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#include "core.h"
38#include "name_table.h"
39#include "port.h"
40#include "subscr.h"
41
42
43
44
45
46
47
48struct tipc_subscriber {
49 int conid;
50 spinlock_t lock;
51 struct list_head subscription_list;
52};
53
54static void subscr_conn_msg_event(int conid, struct sockaddr_tipc *addr,
55 void *usr_data, void *buf, size_t len);
56static void *subscr_named_msg_event(int conid);
57static void subscr_conn_shutdown_event(int conid, void *usr_data);
58
59static atomic_t subscription_count = ATOMIC_INIT(0);
60
61static struct sockaddr_tipc topsrv_addr __read_mostly = {
62 .family = AF_TIPC,
63 .addrtype = TIPC_ADDR_NAMESEQ,
64 .addr.nameseq.type = TIPC_TOP_SRV,
65 .addr.nameseq.lower = TIPC_TOP_SRV,
66 .addr.nameseq.upper = TIPC_TOP_SRV,
67 .scope = TIPC_NODE_SCOPE
68};
69
70static struct tipc_server topsrv __read_mostly = {
71 .saddr = &topsrv_addr,
72 .imp = TIPC_CRITICAL_IMPORTANCE,
73 .type = SOCK_SEQPACKET,
74 .max_rcvbuf_size = sizeof(struct tipc_subscr),
75 .name = "topology_server",
76 .tipc_conn_recvmsg = subscr_conn_msg_event,
77 .tipc_conn_new = subscr_named_msg_event,
78 .tipc_conn_shutdown = subscr_conn_shutdown_event,
79};
80
81
82
83
84
85
86
87
88static u32 htohl(u32 in, int swap)
89{
90 return swap ? swab32(in) : in;
91}
92
93static void subscr_send_event(struct tipc_subscription *sub, u32 found_lower,
94 u32 found_upper, u32 event, u32 port_ref,
95 u32 node)
96{
97 struct tipc_subscriber *subscriber = sub->subscriber;
98 struct kvec msg_sect;
99 int ret;
100
101 msg_sect.iov_base = (void *)&sub->evt;
102 msg_sect.iov_len = sizeof(struct tipc_event);
103
104 sub->evt.event = htohl(event, sub->swap);
105 sub->evt.found_lower = htohl(found_lower, sub->swap);
106 sub->evt.found_upper = htohl(found_upper, sub->swap);
107 sub->evt.port.ref = htohl(port_ref, sub->swap);
108 sub->evt.port.node = htohl(node, sub->swap);
109 ret = tipc_conn_sendmsg(&topsrv, subscriber->conid, NULL,
110 msg_sect.iov_base, msg_sect.iov_len);
111 if (ret < 0)
112 pr_err("Sending subscription event failed, no memory\n");
113}
114
115
116
117
118
119
120int tipc_subscr_overlap(struct tipc_subscription *sub, u32 found_lower,
121 u32 found_upper)
122{
123 if (found_lower < sub->seq.lower)
124 found_lower = sub->seq.lower;
125 if (found_upper > sub->seq.upper)
126 found_upper = sub->seq.upper;
127 if (found_lower > found_upper)
128 return 0;
129 return 1;
130}
131
132
133
134
135
136
137void tipc_subscr_report_overlap(struct tipc_subscription *sub, u32 found_lower,
138 u32 found_upper, u32 event, u32 port_ref,
139 u32 node, int must)
140{
141 if (!tipc_subscr_overlap(sub, found_lower, found_upper))
142 return;
143 if (!must && !(sub->filter & TIPC_SUB_PORTS))
144 return;
145
146 subscr_send_event(sub, found_lower, found_upper, event, port_ref, node);
147}
148
149static void subscr_timeout(struct tipc_subscription *sub)
150{
151 struct tipc_subscriber *subscriber = sub->subscriber;
152
153
154 spin_lock_bh(&subscriber->lock);
155
156
157
158
159 if (subscriber->conid == 0) {
160 spin_unlock_bh(&subscriber->lock);
161 return;
162 }
163
164
165 if (sub->timeout == TIPC_WAIT_FOREVER) {
166 spin_unlock_bh(&subscriber->lock);
167 return;
168 }
169
170
171 tipc_nametbl_unsubscribe(sub);
172
173
174 list_del(&sub->subscription_list);
175
176 spin_unlock_bh(&subscriber->lock);
177
178
179 subscr_send_event(sub, sub->evt.s.seq.lower, sub->evt.s.seq.upper,
180 TIPC_SUBSCR_TIMEOUT, 0, 0);
181
182
183 k_term_timer(&sub->timer);
184 kfree(sub);
185 atomic_dec(&subscription_count);
186}
187
188
189
190
191
192
193static void subscr_del(struct tipc_subscription *sub)
194{
195 tipc_nametbl_unsubscribe(sub);
196 list_del(&sub->subscription_list);
197 kfree(sub);
198 atomic_dec(&subscription_count);
199}
200
201
202
203
204
205
206static void subscr_terminate(struct tipc_subscriber *subscriber)
207{
208 tipc_conn_terminate(&topsrv, subscriber->conid);
209}
210
211static void subscr_release(struct tipc_subscriber *subscriber)
212{
213 struct tipc_subscription *sub;
214 struct tipc_subscription *sub_temp;
215
216 spin_lock_bh(&subscriber->lock);
217
218
219 subscriber->conid = 0;
220
221
222 list_for_each_entry_safe(sub, sub_temp, &subscriber->subscription_list,
223 subscription_list) {
224 if (sub->timeout != TIPC_WAIT_FOREVER) {
225 spin_unlock_bh(&subscriber->lock);
226 k_cancel_timer(&sub->timer);
227 k_term_timer(&sub->timer);
228 spin_lock_bh(&subscriber->lock);
229 }
230 subscr_del(sub);
231 }
232 spin_unlock_bh(&subscriber->lock);
233
234
235 kfree(subscriber);
236}
237
238
239
240
241
242
243
244
245
246
247static void subscr_cancel(struct tipc_subscr *s,
248 struct tipc_subscriber *subscriber)
249{
250 struct tipc_subscription *sub;
251 struct tipc_subscription *sub_temp;
252 int found = 0;
253
254
255 list_for_each_entry_safe(sub, sub_temp, &subscriber->subscription_list,
256 subscription_list) {
257 if (!memcmp(s, &sub->evt.s, sizeof(struct tipc_subscr))) {
258 found = 1;
259 break;
260 }
261 }
262 if (!found)
263 return;
264
265
266 if (sub->timeout != TIPC_WAIT_FOREVER) {
267 sub->timeout = TIPC_WAIT_FOREVER;
268 spin_unlock_bh(&subscriber->lock);
269 k_cancel_timer(&sub->timer);
270 k_term_timer(&sub->timer);
271 spin_lock_bh(&subscriber->lock);
272 }
273 subscr_del(sub);
274}
275
276
277
278
279
280
281static struct tipc_subscription *subscr_subscribe(struct tipc_subscr *s,
282 struct tipc_subscriber *subscriber)
283{
284 struct tipc_subscription *sub;
285 int swap;
286
287
288 swap = !(s->filter & (TIPC_SUB_PORTS | TIPC_SUB_SERVICE));
289
290
291 if (s->filter & htohl(TIPC_SUB_CANCEL, swap)) {
292 s->filter &= ~htohl(TIPC_SUB_CANCEL, swap);
293 subscr_cancel(s, subscriber);
294 return NULL;
295 }
296
297
298 if (atomic_read(&subscription_count) >= TIPC_MAX_SUBSCRIPTIONS) {
299 pr_warn("Subscription rejected, limit reached (%u)\n",
300 TIPC_MAX_SUBSCRIPTIONS);
301 subscr_terminate(subscriber);
302 return NULL;
303 }
304
305
306 sub = kmalloc(sizeof(*sub), GFP_ATOMIC);
307 if (!sub) {
308 pr_warn("Subscription rejected, no memory\n");
309 subscr_terminate(subscriber);
310 return NULL;
311 }
312
313
314 sub->seq.type = htohl(s->seq.type, swap);
315 sub->seq.lower = htohl(s->seq.lower, swap);
316 sub->seq.upper = htohl(s->seq.upper, swap);
317 sub->timeout = htohl(s->timeout, swap);
318 sub->filter = htohl(s->filter, swap);
319 if ((!(sub->filter & TIPC_SUB_PORTS) ==
320 !(sub->filter & TIPC_SUB_SERVICE)) ||
321 (sub->seq.lower > sub->seq.upper)) {
322 pr_warn("Subscription rejected, illegal request\n");
323 kfree(sub);
324 subscr_terminate(subscriber);
325 return NULL;
326 }
327 INIT_LIST_HEAD(&sub->nameseq_list);
328 list_add(&sub->subscription_list, &subscriber->subscription_list);
329 sub->subscriber = subscriber;
330 sub->swap = swap;
331 memcpy(&sub->evt.s, s, sizeof(struct tipc_subscr));
332 atomic_inc(&subscription_count);
333 if (sub->timeout != TIPC_WAIT_FOREVER) {
334 k_init_timer(&sub->timer,
335 (Handler)subscr_timeout, (unsigned long)sub);
336 k_start_timer(&sub->timer, sub->timeout);
337 }
338
339 return sub;
340}
341
342
343static void subscr_conn_shutdown_event(int conid, void *usr_data)
344{
345 subscr_release((struct tipc_subscriber *)usr_data);
346}
347
348
349static void subscr_conn_msg_event(int conid, struct sockaddr_tipc *addr,
350 void *usr_data, void *buf, size_t len)
351{
352 struct tipc_subscriber *subscriber = usr_data;
353 struct tipc_subscription *sub;
354
355 spin_lock_bh(&subscriber->lock);
356 sub = subscr_subscribe((struct tipc_subscr *)buf, subscriber);
357 if (sub)
358 tipc_nametbl_subscribe(sub);
359 spin_unlock_bh(&subscriber->lock);
360}
361
362
363
364static void *subscr_named_msg_event(int conid)
365{
366 struct tipc_subscriber *subscriber;
367
368
369 subscriber = kzalloc(sizeof(struct tipc_subscriber), GFP_ATOMIC);
370 if (subscriber == NULL) {
371 pr_warn("Subscriber rejected, no memory\n");
372 return NULL;
373 }
374 INIT_LIST_HEAD(&subscriber->subscription_list);
375 subscriber->conid = conid;
376 spin_lock_init(&subscriber->lock);
377
378 return (void *)subscriber;
379}
380
381int tipc_subscr_start(void)
382{
383 return tipc_server_start(&topsrv);
384}
385
386void tipc_subscr_stop(void)
387{
388 tipc_server_stop(&topsrv);
389}
390