?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
dm thin: wake worker when discard is prepared
[linux-2.6.git] / net / tipc / port.c
blob07c42fba672be17a4a127b8907f52a3520801f1f
1 /*
2 * net/tipc/port.c: TIPC port code
3 *
4 * Copyright (c) 1992-2007, Ericsson AB
5 * Copyright (c) 2004-2008, 2010-2011, Wind River Systems
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions are met:
10 *
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. Neither the names of the copyright holders nor the names of its
17 * contributors may be used to endorse or promote products derived from
18 * this software without specific prior written permission.
19 *
20 * Alternatively, this software may be distributed under the terms of the
21 * GNU General Public License ("GPL") version 2 as published by the Free
22 * Software Foundation.
23 *
24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
28 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
34 * POSSIBILITY OF SUCH DAMAGE.
35 */
36
37 #include "core.h"
38 #include "config.h"
39 #include "port.h"
40 #include "name_table.h"
41
42 /* Connection management: */
43 #define PROBING_INTERVAL 3600000 /* [ms] => 1 h */
44 #define CONFIRMED 0
45 #define PROBING 1
46
47 #define MAX_REJECT_SIZE 1024
48
49 static struct sk_buff *msg_queue_head;
50 static struct sk_buff *msg_queue_tail;
51
52 DEFINE_SPINLOCK(tipc_port_list_lock);
53 static DEFINE_SPINLOCK(queue_lock);
54
55 static LIST_HEAD(ports);
56 static void port_handle_node_down(unsigned long ref);
57 static struct sk_buff *port_build_self_abort_msg(struct tipc_port *, u32 err);
58 static struct sk_buff *port_build_peer_abort_msg(struct tipc_port *, u32 err);
59 static void port_timeout(unsigned long ref);
60
61
62 static u32 port_peernode(struct tipc_port *p_ptr)
63 {
64 return msg_destnode(&p_ptr->phdr);
65 }
66
67 static u32 port_peerport(struct tipc_port *p_ptr)
68 {
69 return msg_destport(&p_ptr->phdr);
70 }
71
72 /**
73 * tipc_port_peer_msg - verify message was sent by connected port's peer
74 *
75 * Handles cases where the node's network address has changed from
76 * the default of <0.0.0> to its configured setting.
77 */
78 int tipc_port_peer_msg(struct tipc_port *p_ptr, struct tipc_msg *msg)
79 {
80 u32 peernode;
81 u32 orignode;
82
83 if (msg_origport(msg) != port_peerport(p_ptr))
84 return 0;
85
86 orignode = msg_orignode(msg);
87 peernode = port_peernode(p_ptr);
88 return (orignode == peernode) ||
89 (!orignode && (peernode == tipc_own_addr)) ||
90 (!peernode && (orignode == tipc_own_addr));
91 }
92
93 /**
94 * tipc_multicast - send a multicast message to local and remote destinations
95 */
96 int tipc_multicast(u32 ref, struct tipc_name_seq const *seq,
97 u32 num_sect, struct iovec const *msg_sect,
98 unsigned int total_len)
99 {
100 struct tipc_msg *hdr;
101 struct sk_buff *buf;
102 struct sk_buff *ibuf = NULL;
103 struct tipc_port_list dports = {0, NULL, };
104 struct tipc_port *oport = tipc_port_deref(ref);
105 int ext_targets;
106 int res;
107
108 if (unlikely(!oport))
109 return -EINVAL;
110
111 /* Create multicast message */
112 hdr = &oport->phdr;
113 msg_set_type(hdr, TIPC_MCAST_MSG);
114 msg_set_lookup_scope(hdr, TIPC_CLUSTER_SCOPE);
115 msg_set_destport(hdr, 0);
116 msg_set_destnode(hdr, 0);
117 msg_set_nametype(hdr, seq->type);
118 msg_set_namelower(hdr, seq->lower);
119 msg_set_nameupper(hdr, seq->upper);
120 msg_set_hdr_sz(hdr, MCAST_H_SIZE);
121 res = tipc_msg_build(hdr, msg_sect, num_sect, total_len, MAX_MSG_SIZE,
122 !oport->user_port, &buf);
123 if (unlikely(!buf))
124 return res;
125
126 /* Figure out where to send multicast message */
127 ext_targets = tipc_nametbl_mc_translate(seq->type, seq->lower, seq->upper,
128 TIPC_NODE_SCOPE, &dports);
129
130 /* Send message to destinations (duplicate it only if necessary) */
131 if (ext_targets) {
132 if (dports.count != 0) {
133 ibuf = skb_copy(buf, GFP_ATOMIC);
134 if (ibuf == NULL) {
135 tipc_port_list_free(&dports);
136 kfree_skb(buf);
137 return -ENOMEM;
138 }
139 }
140 res = tipc_bclink_send_msg(buf);
141 if ((res < 0) && (dports.count != 0))
142 kfree_skb(ibuf);
143 } else {
144 ibuf = buf;
145 }
146
147 if (res >= 0) {
148 if (ibuf)
149 tipc_port_recv_mcast(ibuf, &dports);
150 } else {
151 tipc_port_list_free(&dports);
152 }
153 return res;
154 }
155
156 /**
157 * tipc_port_recv_mcast - deliver multicast message to all destination ports
158 *
159 * If there is no port list, perform a lookup to create one
160 */
161 void tipc_port_recv_mcast(struct sk_buff *buf, struct tipc_port_list *dp)
162 {
163 struct tipc_msg *msg;
164 struct tipc_port_list dports = {0, NULL, };
165 struct tipc_port_list *item = dp;
166 int cnt = 0;
167
168 msg = buf_msg(buf);
169
170 /* Create destination port list, if one wasn't supplied */
171 if (dp == NULL) {
172 tipc_nametbl_mc_translate(msg_nametype(msg),
173 msg_namelower(msg),
174 msg_nameupper(msg),
175 TIPC_CLUSTER_SCOPE,
176 &dports);
177 item = dp = &dports;
178 }
179
180 /* Deliver a copy of message to each destination port */
181 if (dp->count != 0) {
182 msg_set_destnode(msg, tipc_own_addr);
183 if (dp->count == 1) {
184 msg_set_destport(msg, dp->ports[0]);
185 tipc_port_recv_msg(buf);
186 tipc_port_list_free(dp);
187 return;
188 }
189 for (; cnt < dp->count; cnt++) {
190 int index = cnt % PLSIZE;
191 struct sk_buff *b = skb_clone(buf, GFP_ATOMIC);
192
193 if (b == NULL) {
194 pr_warn("Unable to deliver multicast message(s)\n");
195 goto exit;
196 }
197 if ((index == 0) && (cnt != 0))
198 item = item->next;
199 msg_set_destport(buf_msg(b), item->ports[index]);
200 tipc_port_recv_msg(b);
201 }
202 }
203 exit:
204 kfree_skb(buf);
205 tipc_port_list_free(dp);
206 }
207
208 /**
209 * tipc_createport_raw - create a generic TIPC port
210 *
211 * Returns pointer to (locked) TIPC port, or NULL if unable to create it
212 */
213 struct tipc_port *tipc_createport_raw(void *usr_handle,
214 u32 (*dispatcher)(struct tipc_port *, struct sk_buff *),
215 void (*wakeup)(struct tipc_port *),
216 const u32 importance)
217 {
218 struct tipc_port *p_ptr;
219 struct tipc_msg *msg;
220 u32 ref;
221
222 p_ptr = kzalloc(sizeof(*p_ptr), GFP_ATOMIC);
223 if (!p_ptr) {
224 pr_warn("Port creation failed, no memory\n");
225 return NULL;
226 }
227 ref = tipc_ref_acquire(p_ptr, &p_ptr->lock);
228 if (!ref) {
229 pr_warn("Port creation failed, ref. table exhausted\n");
230 kfree(p_ptr);
231 return NULL;
232 }
233
234 p_ptr->usr_handle = usr_handle;
235 p_ptr->max_pkt = MAX_PKT_DEFAULT;
236 p_ptr->ref = ref;
237 INIT_LIST_HEAD(&p_ptr->wait_list);
238 INIT_LIST_HEAD(&p_ptr->subscription.nodesub_list);
239 p_ptr->dispatcher = dispatcher;
240 p_ptr->wakeup = wakeup;
241 p_ptr->user_port = NULL;
242 k_init_timer(&p_ptr->timer, (Handler)port_timeout, ref);
243 INIT_LIST_HEAD(&p_ptr->publications);
244 INIT_LIST_HEAD(&p_ptr->port_list);
245
246 /*
247 * Must hold port list lock while initializing message header template
248 * to ensure a change to node's own network address doesn't result
249 * in template containing out-dated network address information
250 */
251 spin_lock_bh(&tipc_port_list_lock);
252 msg = &p_ptr->phdr;
253 tipc_msg_init(msg, importance, TIPC_NAMED_MSG, NAMED_H_SIZE, 0);
254 msg_set_origport(msg, ref);
255 list_add_tail(&p_ptr->port_list, &ports);
256 spin_unlock_bh(&tipc_port_list_lock);
257 return p_ptr;
258 }
259
260 int tipc_deleteport(u32 ref)
261 {
262 struct tipc_port *p_ptr;
263 struct sk_buff *buf = NULL;
264
265 tipc_withdraw(ref, 0, NULL);
266 p_ptr = tipc_port_lock(ref);
267 if (!p_ptr)
268 return -EINVAL;
269
270 tipc_ref_discard(ref);
271 tipc_port_unlock(p_ptr);
272
273 k_cancel_timer(&p_ptr->timer);
274 if (p_ptr->connected) {
275 buf = port_build_peer_abort_msg(p_ptr, TIPC_ERR_NO_PORT);
276 tipc_nodesub_unsubscribe(&p_ptr->subscription);
277 }
278 kfree(p_ptr->user_port);
279
280 spin_lock_bh(&tipc_port_list_lock);
281 list_del(&p_ptr->port_list);
282 list_del(&p_ptr->wait_list);
283 spin_unlock_bh(&tipc_port_list_lock);
284 k_term_timer(&p_ptr->timer);
285 kfree(p_ptr);
286 tipc_net_route_msg(buf);
287 return 0;
288 }
289
290 static int port_unreliable(struct tipc_port *p_ptr)
291 {
292 return msg_src_droppable(&p_ptr->phdr);
293 }
294
295 int tipc_portunreliable(u32 ref, unsigned int *isunreliable)
296 {
297 struct tipc_port *p_ptr;
298
299 p_ptr = tipc_port_lock(ref);
300 if (!p_ptr)
301 return -EINVAL;
302 *isunreliable = port_unreliable(p_ptr);
303 tipc_port_unlock(p_ptr);
304 return 0;
305 }
306
307 int tipc_set_portunreliable(u32 ref, unsigned int isunreliable)
308 {
309 struct tipc_port *p_ptr;
310
311 p_ptr = tipc_port_lock(ref);
312 if (!p_ptr)
313 return -EINVAL;
314 msg_set_src_droppable(&p_ptr->phdr, (isunreliable != 0));
315 tipc_port_unlock(p_ptr);
316 return 0;
317 }
318
319 static int port_unreturnable(struct tipc_port *p_ptr)
320 {
321 return msg_dest_droppable(&p_ptr->phdr);
322 }
323
324 int tipc_portunreturnable(u32 ref, unsigned int *isunrejectable)
325 {
326 struct tipc_port *p_ptr;
327
328 p_ptr = tipc_port_lock(ref);
329 if (!p_ptr)
330 return -EINVAL;
331 *isunrejectable = port_unreturnable(p_ptr);
332 tipc_port_unlock(p_ptr);
333 return 0;
334 }
335
336 int tipc_set_portunreturnable(u32 ref, unsigned int isunrejectable)
337 {
338 struct tipc_port *p_ptr;
339
340 p_ptr = tipc_port_lock(ref);
341 if (!p_ptr)
342 return -EINVAL;
343 msg_set_dest_droppable(&p_ptr->phdr, (isunrejectable != 0));
344 tipc_port_unlock(p_ptr);
345 return 0;
346 }
347
348 /*
349 * port_build_proto_msg(): create connection protocol message for port
350 *
351 * On entry the port must be locked and connected.
352 */
353 static struct sk_buff *port_build_proto_msg(struct tipc_port *p_ptr,
354 u32 type, u32 ack)
355 {
356 struct sk_buff *buf;
357 struct tipc_msg *msg;
358
359 buf = tipc_buf_acquire(INT_H_SIZE);
360 if (buf) {
361 msg = buf_msg(buf);
362 tipc_msg_init(msg, CONN_MANAGER, type, INT_H_SIZE,
363 port_peernode(p_ptr));
364 msg_set_destport(msg, port_peerport(p_ptr));
365 msg_set_origport(msg, p_ptr->ref);
366 msg_set_msgcnt(msg, ack);
367 }
368 return buf;
369 }
370
371 int tipc_reject_msg(struct sk_buff *buf, u32 err)
372 {
373 struct tipc_msg *msg = buf_msg(buf);
374 struct sk_buff *rbuf;
375 struct tipc_msg *rmsg;
376 int hdr_sz;
377 u32 imp;
378 u32 data_sz = msg_data_sz(msg);
379 u32 src_node;
380 u32 rmsg_sz;
381
382 /* discard rejected message if it shouldn't be returned to sender */
383 if (WARN(!msg_isdata(msg),
384 "attempt to reject message with user=%u", msg_user(msg))) {
385 dump_stack();
386 goto exit;
387 }
388 if (msg_errcode(msg) || msg_dest_droppable(msg))
389 goto exit;
390
391 /*
392 * construct returned message by copying rejected message header and
393 * data (or subset), then updating header fields that need adjusting
394 */
395 hdr_sz = msg_hdr_sz(msg);
396 rmsg_sz = hdr_sz + min_t(u32, data_sz, MAX_REJECT_SIZE);
397
398 rbuf = tipc_buf_acquire(rmsg_sz);
399 if (rbuf == NULL)
400 goto exit;
401
402 rmsg = buf_msg(rbuf);
403 skb_copy_to_linear_data(rbuf, msg, rmsg_sz);
404
405 if (msg_connected(rmsg)) {
406 imp = msg_importance(rmsg);
407 if (imp < TIPC_CRITICAL_IMPORTANCE)
408 msg_set_importance(rmsg, ++imp);
409 }
410 msg_set_non_seq(rmsg, 0);
411 msg_set_size(rmsg, rmsg_sz);
412 msg_set_errcode(rmsg, err);
413 msg_set_prevnode(rmsg, tipc_own_addr);
414 msg_swap_words(rmsg, 4, 5);
415 if (!msg_short(rmsg))
416 msg_swap_words(rmsg, 6, 7);
417
418 /* send self-abort message when rejecting on a connected port */
419 if (msg_connected(msg)) {
420 struct tipc_port *p_ptr = tipc_port_lock(msg_destport(msg));
421
422 if (p_ptr) {
423 struct sk_buff *abuf = NULL;
424
425 if (p_ptr->connected)
426 abuf = port_build_self_abort_msg(p_ptr, err);
427 tipc_port_unlock(p_ptr);
428 tipc_net_route_msg(abuf);
429 }
430 }
431
432 /* send returned message & dispose of rejected message */
433 src_node = msg_prevnode(msg);
434 if (in_own_node(src_node))
435 tipc_port_recv_msg(rbuf);
436 else
437 tipc_link_send(rbuf, src_node, msg_link_selector(rmsg));
438 exit:
439 kfree_skb(buf);
440 return data_sz;
441 }
442
443 int tipc_port_reject_sections(struct tipc_port *p_ptr, struct tipc_msg *hdr,
444 struct iovec const *msg_sect, u32 num_sect,
445 unsigned int total_len, int err)
446 {
447 struct sk_buff *buf;
448 int res;
449
450 res = tipc_msg_build(hdr, msg_sect, num_sect, total_len, MAX_MSG_SIZE,
451 !p_ptr->user_port, &buf);
452 if (!buf)
453 return res;
454
455 return tipc_reject_msg(buf, err);
456 }
457
458 static void port_timeout(unsigned long ref)
459 {
460 struct tipc_port *p_ptr = tipc_port_lock(ref);
461 struct sk_buff *buf = NULL;
462
463 if (!p_ptr)
464 return;
465
466 if (!p_ptr->connected) {
467 tipc_port_unlock(p_ptr);
468 return;
469 }
470
471 /* Last probe answered ? */
472 if (p_ptr->probing_state == PROBING) {
473 buf = port_build_self_abort_msg(p_ptr, TIPC_ERR_NO_PORT);
474 } else {
475 buf = port_build_proto_msg(p_ptr, CONN_PROBE, 0);
476 p_ptr->probing_state = PROBING;
477 k_start_timer(&p_ptr->timer, p_ptr->probing_interval);
478 }
479 tipc_port_unlock(p_ptr);
480 tipc_net_route_msg(buf);
481 }
482
483
484 static void port_handle_node_down(unsigned long ref)
485 {
486 struct tipc_port *p_ptr = tipc_port_lock(ref);
487 struct sk_buff *buf = NULL;
488
489 if (!p_ptr)
490 return;
491 buf = port_build_self_abort_msg(p_ptr, TIPC_ERR_NO_NODE);
492 tipc_port_unlock(p_ptr);
493 tipc_net_route_msg(buf);
494 }
495
496
497 static struct sk_buff *port_build_self_abort_msg(struct tipc_port *p_ptr, u32 err)
498 {
499 struct sk_buff *buf = port_build_peer_abort_msg(p_ptr, err);
500
501 if (buf) {
502 struct tipc_msg *msg = buf_msg(buf);
503 msg_swap_words(msg, 4, 5);
504 msg_swap_words(msg, 6, 7);
505 }
506 return buf;
507 }
508
509
510 static struct sk_buff *port_build_peer_abort_msg(struct tipc_port *p_ptr, u32 err)
511 {
512 struct sk_buff *buf;
513 struct tipc_msg *msg;
514 u32 imp;
515
516 if (!p_ptr->connected)
517 return NULL;
518
519 buf = tipc_buf_acquire(BASIC_H_SIZE);
520 if (buf) {
521 msg = buf_msg(buf);
522 memcpy(msg, &p_ptr->phdr, BASIC_H_SIZE);
523 msg_set_hdr_sz(msg, BASIC_H_SIZE);
524 msg_set_size(msg, BASIC_H_SIZE);
525 imp = msg_importance(msg);
526 if (imp < TIPC_CRITICAL_IMPORTANCE)
527 msg_set_importance(msg, ++imp);
528 msg_set_errcode(msg, err);
529 }
530 return buf;
531 }
532
533 void tipc_port_recv_proto_msg(struct sk_buff *buf)
534 {
535 struct tipc_msg *msg = buf_msg(buf);
536 struct tipc_port *p_ptr;
537 struct sk_buff *r_buf = NULL;
538 u32 destport = msg_destport(msg);
539 int wakeable;
540
541 /* Validate connection */
542 p_ptr = tipc_port_lock(destport);
543 if (!p_ptr || !p_ptr->connected || !tipc_port_peer_msg(p_ptr, msg)) {
544 r_buf = tipc_buf_acquire(BASIC_H_SIZE);
545 if (r_buf) {
546 msg = buf_msg(r_buf);
547 tipc_msg_init(msg, TIPC_HIGH_IMPORTANCE, TIPC_CONN_MSG,
548 BASIC_H_SIZE, msg_orignode(msg));
549 msg_set_errcode(msg, TIPC_ERR_NO_PORT);
550 msg_set_origport(msg, destport);
551 msg_set_destport(msg, msg_origport(msg));
552 }
553 if (p_ptr)
554 tipc_port_unlock(p_ptr);
555 goto exit;
556 }
557
558 /* Process protocol message sent by peer */
559 switch (msg_type(msg)) {
560 case CONN_ACK:
561 wakeable = tipc_port_congested(p_ptr) && p_ptr->congested &&
562 p_ptr->wakeup;
563 p_ptr->acked += msg_msgcnt(msg);
564 if (!tipc_port_congested(p_ptr)) {
565 p_ptr->congested = 0;
566 if (wakeable)
567 p_ptr->wakeup(p_ptr);
568 }
569 break;
570 case CONN_PROBE:
571 r_buf = port_build_proto_msg(p_ptr, CONN_PROBE_REPLY, 0);
572 break;
573 default:
574 /* CONN_PROBE_REPLY or unrecognized - no action required */
575 break;
576 }
577 p_ptr->probing_state = CONFIRMED;
578 tipc_port_unlock(p_ptr);
579 exit:
580 tipc_net_route_msg(r_buf);
581 kfree_skb(buf);
582 }
583
584 static int port_print(struct tipc_port *p_ptr, char *buf, int len, int full_id)
585 {
586 struct publication *publ;
587 int ret;
588
589 if (full_id)
590 ret = tipc_snprintf(buf, len, "<%u.%u.%u:%u>:",
591 tipc_zone(tipc_own_addr),
592 tipc_cluster(tipc_own_addr),
593 tipc_node(tipc_own_addr), p_ptr->ref);
594 else
595 ret = tipc_snprintf(buf, len, "%-10u:", p_ptr->ref);
596
597 if (p_ptr->connected) {
598 u32 dport = port_peerport(p_ptr);
599 u32 destnode = port_peernode(p_ptr);
600
601 ret += tipc_snprintf(buf + ret, len - ret,
602 " connected to <%u.%u.%u:%u>",
603 tipc_zone(destnode),
604 tipc_cluster(destnode),
605 tipc_node(destnode), dport);
606 if (p_ptr->conn_type != 0)
607 ret += tipc_snprintf(buf + ret, len - ret,
608 " via {%u,%u}", p_ptr->conn_type,
609 p_ptr->conn_instance);
610 } else if (p_ptr->published) {
611 ret += tipc_snprintf(buf + ret, len - ret, " bound to");
612 list_for_each_entry(publ, &p_ptr->publications, pport_list) {
613 if (publ->lower == publ->upper)
614 ret += tipc_snprintf(buf + ret, len - ret,
615 " {%u,%u}", publ->type,
616 publ->lower);
617 else
618 ret += tipc_snprintf(buf + ret, len - ret,
619 " {%u,%u,%u}", publ->type,
620 publ->lower, publ->upper);
621 }
622 }
623 ret += tipc_snprintf(buf + ret, len - ret, "\n");
624 return ret;
625 }
626
627 struct sk_buff *tipc_port_get_ports(void)
628 {
629 struct sk_buff *buf;
630 struct tlv_desc *rep_tlv;
631 char *pb;
632 int pb_len;
633 struct tipc_port *p_ptr;
634 int str_len = 0;
635
636 buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
637 if (!buf)
638 return NULL;
639 rep_tlv = (struct tlv_desc *)buf->data;
640 pb = TLV_DATA(rep_tlv);
641 pb_len = ULTRA_STRING_MAX_LEN;
642
643 spin_lock_bh(&tipc_port_list_lock);
644 list_for_each_entry(p_ptr, &ports, port_list) {
645 spin_lock_bh(p_ptr->lock);
646 str_len += port_print(p_ptr, pb, pb_len, 0);
647 spin_unlock_bh(p_ptr->lock);
648 }
649 spin_unlock_bh(&tipc_port_list_lock);
650 str_len += 1; /* for "\0" */
651 skb_put(buf, TLV_SPACE(str_len));
652 TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
653
654 return buf;
655 }
656
657 void tipc_port_reinit(void)
658 {
659 struct tipc_port *p_ptr;
660 struct tipc_msg *msg;
661
662 spin_lock_bh(&tipc_port_list_lock);
663 list_for_each_entry(p_ptr, &ports, port_list) {
664 msg = &p_ptr->phdr;
665 msg_set_prevnode(msg, tipc_own_addr);
666 msg_set_orignode(msg, tipc_own_addr);
667 }
668 spin_unlock_bh(&tipc_port_list_lock);
669 }
670
671
672 /*
673 * port_dispatcher_sigh(): Signal handler for messages destinated
674 * to the tipc_port interface.
675 */
676 static void port_dispatcher_sigh(void *dummy)
677 {
678 struct sk_buff *buf;
679
680 spin_lock_bh(&queue_lock);
681 buf = msg_queue_head;
682 msg_queue_head = NULL;
683 spin_unlock_bh(&queue_lock);
684
685 while (buf) {
686 struct tipc_port *p_ptr;
687 struct user_port *up_ptr;
688 struct tipc_portid orig;
689 struct tipc_name_seq dseq;
690 void *usr_handle;
691 int connected;
692 int peer_invalid;
693 int published;
694 u32 message_type;
695
696 struct sk_buff *next = buf->next;
697 struct tipc_msg *msg = buf_msg(buf);
698 u32 dref = msg_destport(msg);
699
700 message_type = msg_type(msg);
701 if (message_type > TIPC_DIRECT_MSG)
702 goto reject; /* Unsupported message type */
703
704 p_ptr = tipc_port_lock(dref);
705 if (!p_ptr)
706 goto reject; /* Port deleted while msg in queue */
707
708 orig.ref = msg_origport(msg);
709 orig.node = msg_orignode(msg);
710 up_ptr = p_ptr->user_port;
711 usr_handle = up_ptr->usr_handle;
712 connected = p_ptr->connected;
713 peer_invalid = connected && !tipc_port_peer_msg(p_ptr, msg);
714 published = p_ptr->published;
715
716 if (unlikely(msg_errcode(msg)))
717 goto err;
718
719 switch (message_type) {
720
721 case TIPC_CONN_MSG:{
722 tipc_conn_msg_event cb = up_ptr->conn_msg_cb;
723 u32 dsz;
724
725 tipc_port_unlock(p_ptr);
726 if (unlikely(!cb))
727 goto reject;
728 if (unlikely(!connected)) {
729 if (tipc_connect2port(dref, &orig))
730 goto reject;
731 } else if (peer_invalid)
732 goto reject;
733 dsz = msg_data_sz(msg);
734 if (unlikely(dsz &&
735 (++p_ptr->conn_unacked >=
736 TIPC_FLOW_CONTROL_WIN)))
737 tipc_acknowledge(dref,
738 p_ptr->conn_unacked);
739 skb_pull(buf, msg_hdr_sz(msg));
740 cb(usr_handle, dref, &buf, msg_data(msg), dsz);
741 break;
742 }
743 case TIPC_DIRECT_MSG:{
744 tipc_msg_event cb = up_ptr->msg_cb;
745
746 tipc_port_unlock(p_ptr);
747 if (unlikely(!cb || connected))
748 goto reject;
749 skb_pull(buf, msg_hdr_sz(msg));
750 cb(usr_handle, dref, &buf, msg_data(msg),
751 msg_data_sz(msg), msg_importance(msg),
752 &orig);
753 break;
754 }
755 case TIPC_MCAST_MSG:
756 case TIPC_NAMED_MSG:{
757 tipc_named_msg_event cb = up_ptr->named_msg_cb;
758
759 tipc_port_unlock(p_ptr);
760 if (unlikely(!cb || connected || !published))
761 goto reject;
762 dseq.type = msg_nametype(msg);
763 dseq.lower = msg_nameinst(msg);
764 dseq.upper = (message_type == TIPC_NAMED_MSG)
765 ? dseq.lower : msg_nameupper(msg);
766 skb_pull(buf, msg_hdr_sz(msg));
767 cb(usr_handle, dref, &buf, msg_data(msg),
768 msg_data_sz(msg), msg_importance(msg),
769 &orig, &dseq);
770 break;
771 }
772 }
773 if (buf)
774 kfree_skb(buf);
775 buf = next;
776 continue;
777 err:
778 switch (message_type) {
779
780 case TIPC_CONN_MSG:{
781 tipc_conn_shutdown_event cb =
782 up_ptr->conn_err_cb;
783
784 tipc_port_unlock(p_ptr);
785 if (!cb || !connected || peer_invalid)
786 break;
787 tipc_disconnect(dref);
788 skb_pull(buf, msg_hdr_sz(msg));
789 cb(usr_handle, dref, &buf, msg_data(msg),
790 msg_data_sz(msg), msg_errcode(msg));
791 break;
792 }
793 case TIPC_DIRECT_MSG:{
794 tipc_msg_err_event cb = up_ptr->err_cb;
795
796 tipc_port_unlock(p_ptr);
797 if (!cb || connected)
798 break;
799 skb_pull(buf, msg_hdr_sz(msg));
800 cb(usr_handle, dref, &buf, msg_data(msg),
801 msg_data_sz(msg), msg_errcode(msg), &orig);
802 break;
803 }
804 case TIPC_MCAST_MSG:
805 case TIPC_NAMED_MSG:{
806 tipc_named_msg_err_event cb =
807 up_ptr->named_err_cb;
808
809 tipc_port_unlock(p_ptr);
810 if (!cb || connected)
811 break;
812 dseq.type = msg_nametype(msg);
813 dseq.lower = msg_nameinst(msg);
814 dseq.upper = (message_type == TIPC_NAMED_MSG)
815 ? dseq.lower : msg_nameupper(msg);
816 skb_pull(buf, msg_hdr_sz(msg));
817 cb(usr_handle, dref, &buf, msg_data(msg),
818 msg_data_sz(msg), msg_errcode(msg), &dseq);
819 break;
820 }
821 }
822 if (buf)
823 kfree_skb(buf);
824 buf = next;
825 continue;
826 reject:
827 tipc_reject_msg(buf, TIPC_ERR_NO_PORT);
828 buf = next;
829 }
830 }
831
832 /*
833 * port_dispatcher(): Dispatcher for messages destinated
834 * to the tipc_port interface. Called with port locked.
835 */
836 static u32 port_dispatcher(struct tipc_port *dummy, struct sk_buff *buf)
837 {
838 buf->next = NULL;
839 spin_lock_bh(&queue_lock);
840 if (msg_queue_head) {
841 msg_queue_tail->next = buf;
842 msg_queue_tail = buf;
843 } else {
844 msg_queue_tail = msg_queue_head = buf;
845 tipc_k_signal((Handler)port_dispatcher_sigh, 0);
846 }
847 spin_unlock_bh(&queue_lock);
848 return 0;
849 }
850
851 /*
852 * Wake up port after congestion: Called with port locked
853 */
854 static void port_wakeup_sh(unsigned long ref)
855 {
856 struct tipc_port *p_ptr;
857 struct user_port *up_ptr;
858 tipc_continue_event cb = NULL;
859 void *uh = NULL;
860
861 p_ptr = tipc_port_lock(ref);
862 if (p_ptr) {
863 up_ptr = p_ptr->user_port;
864 if (up_ptr) {
865 cb = up_ptr->continue_event_cb;
866 uh = up_ptr->usr_handle;
867 }
868 tipc_port_unlock(p_ptr);
869 }
870 if (cb)
871 cb(uh, ref);
872 }
873
874
875 static void port_wakeup(struct tipc_port *p_ptr)
876 {
877 tipc_k_signal((Handler)port_wakeup_sh, p_ptr->ref);
878 }
879
880 void tipc_acknowledge(u32 ref, u32 ack)
881 {
882 struct tipc_port *p_ptr;
883 struct sk_buff *buf = NULL;
884
885 p_ptr = tipc_port_lock(ref);
886 if (!p_ptr)
887 return;
888 if (p_ptr->connected) {
889 p_ptr->conn_unacked -= ack;
890 buf = port_build_proto_msg(p_ptr, CONN_ACK, ack);
891 }
892 tipc_port_unlock(p_ptr);
893 tipc_net_route_msg(buf);
894 }
895
896 /*
897 * tipc_createport(): user level call.
898 */
899 int tipc_createport(void *usr_handle,
900 unsigned int importance,
901 tipc_msg_err_event error_cb,
902 tipc_named_msg_err_event named_error_cb,
903 tipc_conn_shutdown_event conn_error_cb,
904 tipc_msg_event msg_cb,
905 tipc_named_msg_event named_msg_cb,
906 tipc_conn_msg_event conn_msg_cb,
907 tipc_continue_event continue_event_cb, /* May be zero */
908 u32 *portref)
909 {
910 struct user_port *up_ptr;
911 struct tipc_port *p_ptr;
912
913 up_ptr = kmalloc(sizeof(*up_ptr), GFP_ATOMIC);
914 if (!up_ptr) {
915 pr_warn("Port creation failed, no memory\n");
916 return -ENOMEM;
917 }
918 p_ptr = tipc_createport_raw(NULL, port_dispatcher, port_wakeup,
919 importance);
920 if (!p_ptr) {
921 kfree(up_ptr);
922 return -ENOMEM;
923 }
924
925 p_ptr->user_port = up_ptr;
926 up_ptr->usr_handle = usr_handle;
927 up_ptr->ref = p_ptr->ref;
928 up_ptr->err_cb = error_cb;
929 up_ptr->named_err_cb = named_error_cb;
930 up_ptr->conn_err_cb = conn_error_cb;
931 up_ptr->msg_cb = msg_cb;
932 up_ptr->named_msg_cb = named_msg_cb;
933 up_ptr->conn_msg_cb = conn_msg_cb;
934 up_ptr->continue_event_cb = continue_event_cb;
935 *portref = p_ptr->ref;
936 tipc_port_unlock(p_ptr);
937 return 0;
938 }
939
940 int tipc_portimportance(u32 ref, unsigned int *importance)
941 {
942 struct tipc_port *p_ptr;
943
944 p_ptr = tipc_port_lock(ref);
945 if (!p_ptr)
946 return -EINVAL;
947 *importance = (unsigned int)msg_importance(&p_ptr->phdr);
948 tipc_port_unlock(p_ptr);
949 return 0;
950 }
951
952 int tipc_set_portimportance(u32 ref, unsigned int imp)
953 {
954 struct tipc_port *p_ptr;
955
956 if (imp > TIPC_CRITICAL_IMPORTANCE)
957 return -EINVAL;
958
959 p_ptr = tipc_port_lock(ref);
960 if (!p_ptr)
961 return -EINVAL;
962 msg_set_importance(&p_ptr->phdr, (u32)imp);
963 tipc_port_unlock(p_ptr);
964 return 0;
965 }
966
967
968 int tipc_publish(u32 ref, unsigned int scope, struct tipc_name_seq const *seq)
969 {
970 struct tipc_port *p_ptr;
971 struct publication *publ;
972 u32 key;
973 int res = -EINVAL;
974
975 p_ptr = tipc_port_lock(ref);
976 if (!p_ptr)
977 return -EINVAL;
978
979 if (p_ptr->connected)
980 goto exit;
981 key = ref + p_ptr->pub_count + 1;
982 if (key == ref) {
983 res = -EADDRINUSE;
984 goto exit;
985 }
986 publ = tipc_nametbl_publish(seq->type, seq->lower, seq->upper,
987 scope, p_ptr->ref, key);
988 if (publ) {
989 list_add(&publ->pport_list, &p_ptr->publications);
990 p_ptr->pub_count++;
991 p_ptr->published = 1;
992 res = 0;
993 }
994 exit:
995 tipc_port_unlock(p_ptr);
996 return res;
997 }
998
999 int tipc_withdraw(u32 ref, unsigned int scope, struct tipc_name_seq const *seq)
1000 {
1001 struct tipc_port *p_ptr;
1002 struct publication *publ;
1003 struct publication *tpubl;
1004 int res = -EINVAL;
1005
1006 p_ptr = tipc_port_lock(ref);
1007 if (!p_ptr)
1008 return -EINVAL;
1009 if (!seq) {
1010 list_for_each_entry_safe(publ, tpubl,
1011 &p_ptr->publications, pport_list) {
1012 tipc_nametbl_withdraw(publ->type, publ->lower,
1013 publ->ref, publ->key);
1014 }
1015 res = 0;
1016 } else {
1017 list_for_each_entry_safe(publ, tpubl,
1018 &p_ptr->publications, pport_list) {
1019 if (publ->scope != scope)
1020 continue;
1021 if (publ->type != seq->type)
1022 continue;
1023 if (publ->lower != seq->lower)
1024 continue;
1025 if (publ->upper != seq->upper)
1026 break;
1027 tipc_nametbl_withdraw(publ->type, publ->lower,
1028 publ->ref, publ->key);
1029 res = 0;
1030 break;
1031 }
1032 }
1033 if (list_empty(&p_ptr->publications))
1034 p_ptr->published = 0;
1035 tipc_port_unlock(p_ptr);
1036 return res;
1037 }
1038
1039 int tipc_connect2port(u32 ref, struct tipc_portid const *peer)
1040 {
1041 struct tipc_port *p_ptr;
1042 struct tipc_msg *msg;
1043 int res = -EINVAL;
1044
1045 p_ptr = tipc_port_lock(ref);
1046 if (!p_ptr)
1047 return -EINVAL;
1048 if (p_ptr->published || p_ptr->connected)
1049 goto exit;
1050 if (!peer->ref)
1051 goto exit;
1052
1053 msg = &p_ptr->phdr;
1054 msg_set_destnode(msg, peer->node);
1055 msg_set_destport(msg, peer->ref);
1056 msg_set_type(msg, TIPC_CONN_MSG);
1057 msg_set_lookup_scope(msg, 0);
1058 msg_set_hdr_sz(msg, SHORT_H_SIZE);
1059
1060 p_ptr->probing_interval = PROBING_INTERVAL;
1061 p_ptr->probing_state = CONFIRMED;
1062 p_ptr->connected = 1;
1063 k_start_timer(&p_ptr->timer, p_ptr->probing_interval);
1064
1065 tipc_nodesub_subscribe(&p_ptr->subscription, peer->node,
1066 (void *)(unsigned long)ref,
1067 (net_ev_handler)port_handle_node_down);
1068 res = 0;
1069 exit:
1070 tipc_port_unlock(p_ptr);
1071 p_ptr->max_pkt = tipc_link_get_max_pkt(peer->node, ref);
1072 return res;
1073 }
1074
1075 /**
1076 * tipc_disconnect_port - disconnect port from peer
1077 *
1078 * Port must be locked.
1079 */
1080 int tipc_disconnect_port(struct tipc_port *tp_ptr)
1081 {
1082 int res;
1083
1084 if (tp_ptr->connected) {
1085 tp_ptr->connected = 0;
1086 /* let timer expire on it's own to avoid deadlock! */
1087 tipc_nodesub_unsubscribe(&tp_ptr->subscription);
1088 res = 0;
1089 } else {
1090 res = -ENOTCONN;
1091 }
1092 return res;
1093 }
1094
1095 /*
1096 * tipc_disconnect(): Disconnect port form peer.
1097 * This is a node local operation.
1098 */
1099 int tipc_disconnect(u32 ref)
1100 {
1101 struct tipc_port *p_ptr;
1102 int res;
1103
1104 p_ptr = tipc_port_lock(ref);
1105 if (!p_ptr)
1106 return -EINVAL;
1107 res = tipc_disconnect_port(p_ptr);
1108 tipc_port_unlock(p_ptr);
1109 return res;
1110 }
1111
1112 /*
1113 * tipc_shutdown(): Send a SHUTDOWN msg to peer and disconnect
1114 */
1115 int tipc_shutdown(u32 ref)
1116 {
1117 struct tipc_port *p_ptr;
1118 struct sk_buff *buf = NULL;
1119
1120 p_ptr = tipc_port_lock(ref);
1121 if (!p_ptr)
1122 return -EINVAL;
1123
1124 buf = port_build_peer_abort_msg(p_ptr, TIPC_CONN_SHUTDOWN);
1125 tipc_port_unlock(p_ptr);
1126 tipc_net_route_msg(buf);
1127 return tipc_disconnect(ref);
1128 }
1129
1130 /**
1131 * tipc_port_recv_msg - receive message from lower layer and deliver to port user
1132 */
1133 int tipc_port_recv_msg(struct sk_buff *buf)
1134 {
1135 struct tipc_port *p_ptr;
1136 struct tipc_msg *msg = buf_msg(buf);
1137 u32 destport = msg_destport(msg);
1138 u32 dsz = msg_data_sz(msg);
1139 u32 err;
1140
1141 /* forward unresolved named message */
1142 if (unlikely(!destport)) {
1143 tipc_net_route_msg(buf);
1144 return dsz;
1145 }
1146
1147 /* validate destination & pass to port, otherwise reject message */
1148 p_ptr = tipc_port_lock(destport);
1149 if (likely(p_ptr)) {
1150 err = p_ptr->dispatcher(p_ptr, buf);
1151 tipc_port_unlock(p_ptr);
1152 if (likely(!err))
1153 return dsz;
1154 } else {
1155 err = TIPC_ERR_NO_PORT;
1156 }
1157
1158 return tipc_reject_msg(buf, err);
1159 }
1160
1161 /*
1162 * tipc_port_recv_sections(): Concatenate and deliver sectioned
1163 * message for this node.
1164 */
1165 static int tipc_port_recv_sections(struct tipc_port *sender, unsigned int num_sect,
1166 struct iovec const *msg_sect,
1167 unsigned int total_len)
1168 {
1169 struct sk_buff *buf;
1170 int res;
1171
1172 res = tipc_msg_build(&sender->phdr, msg_sect, num_sect, total_len,
1173 MAX_MSG_SIZE, !sender->user_port, &buf);
1174 if (likely(buf))
1175 tipc_port_recv_msg(buf);
1176 return res;
1177 }
1178
1179 /**
1180 * tipc_send - send message sections on connection
1181 */
1182 int tipc_send(u32 ref, unsigned int num_sect, struct iovec const *msg_sect,
1183 unsigned int total_len)
1184 {
1185 struct tipc_port *p_ptr;
1186 u32 destnode;
1187 int res;
1188
1189 p_ptr = tipc_port_deref(ref);
1190 if (!p_ptr || !p_ptr->connected)
1191 return -EINVAL;
1192
1193 p_ptr->congested = 1;
1194 if (!tipc_port_congested(p_ptr)) {
1195 destnode = port_peernode(p_ptr);
1196 if (likely(!in_own_node(destnode)))
1197 res = tipc_link_send_sections_fast(p_ptr, msg_sect, num_sect,
1198 total_len, destnode);
1199 else
1200 res = tipc_port_recv_sections(p_ptr, num_sect, msg_sect,
1201 total_len);
1202
1203 if (likely(res != -ELINKCONG)) {
1204 p_ptr->congested = 0;
1205 if (res > 0)
1206 p_ptr->sent++;
1207 return res;
1208 }
1209 }
1210 if (port_unreliable(p_ptr)) {
1211 p_ptr->congested = 0;
1212 return total_len;
1213 }
1214 return -ELINKCONG;
1215 }
1216
1217 /**
1218 * tipc_send2name - send message sections to port name
1219 */
1220 int tipc_send2name(u32 ref, struct tipc_name const *name, unsigned int domain,
1221 unsigned int num_sect, struct iovec const *msg_sect,
1222 unsigned int total_len)
1223 {
1224 struct tipc_port *p_ptr;
1225 struct tipc_msg *msg;
1226 u32 destnode = domain;
1227 u32 destport;
1228 int res;
1229
1230 p_ptr = tipc_port_deref(ref);
1231 if (!p_ptr || p_ptr->connected)
1232 return -EINVAL;
1233
1234 msg = &p_ptr->phdr;
1235 msg_set_type(msg, TIPC_NAMED_MSG);
1236 msg_set_hdr_sz(msg, NAMED_H_SIZE);
1237 msg_set_nametype(msg, name->type);
1238 msg_set_nameinst(msg, name->instance);
1239 msg_set_lookup_scope(msg, tipc_addr_scope(domain));
1240 destport = tipc_nametbl_translate(name->type, name->instance, &destnode);
1241 msg_set_destnode(msg, destnode);
1242 msg_set_destport(msg, destport);
1243
1244 if (likely(destport || destnode)) {
1245 if (likely(in_own_node(destnode)))
1246 res = tipc_port_recv_sections(p_ptr, num_sect,
1247 msg_sect, total_len);
1248 else if (tipc_own_addr)
1249 res = tipc_link_send_sections_fast(p_ptr, msg_sect,
1250 num_sect, total_len,
1251 destnode);
1252 else
1253 res = tipc_port_reject_sections(p_ptr, msg, msg_sect,
1254 num_sect, total_len,
1255 TIPC_ERR_NO_NODE);
1256 if (likely(res != -ELINKCONG)) {
1257 if (res > 0)
1258 p_ptr->sent++;
1259 return res;
1260 }
1261 if (port_unreliable(p_ptr)) {
1262 return total_len;
1263 }
1264 return -ELINKCONG;
1265 }
1266 return tipc_port_reject_sections(p_ptr, msg, msg_sect, num_sect,
1267 total_len, TIPC_ERR_NO_NAME);
1268 }
1269
1270 /**
1271 * tipc_send2port - send message sections to port identity
1272 */
1273 int tipc_send2port(u32 ref, struct tipc_portid const *dest,
1274 unsigned int num_sect, struct iovec const *msg_sect,
1275 unsigned int total_len)
1276 {
1277 struct tipc_port *p_ptr;
1278 struct tipc_msg *msg;
1279 int res;
1280
1281 p_ptr = tipc_port_deref(ref);
1282 if (!p_ptr || p_ptr->connected)
1283 return -EINVAL;
1284
1285 msg = &p_ptr->phdr;
1286 msg_set_type(msg, TIPC_DIRECT_MSG);
1287 msg_set_lookup_scope(msg, 0);
1288 msg_set_destnode(msg, dest->node);
1289 msg_set_destport(msg, dest->ref);
1290 msg_set_hdr_sz(msg, BASIC_H_SIZE);
1291
1292 if (in_own_node(dest->node))
1293 res = tipc_port_recv_sections(p_ptr, num_sect, msg_sect,
1294 total_len);
1295 else if (tipc_own_addr)
1296 res = tipc_link_send_sections_fast(p_ptr, msg_sect, num_sect,
1297 total_len, dest->node);
1298 else
1299 res = tipc_port_reject_sections(p_ptr, msg, msg_sect, num_sect,
1300 total_len, TIPC_ERR_NO_NODE);
1301 if (likely(res != -ELINKCONG)) {
1302 if (res > 0)
1303 p_ptr->sent++;
1304 return res;
1305 }
1306 if (port_unreliable(p_ptr)) {
1307 return total_len;
1308 }
1309 return -ELINKCONG;
1310 }
1311
1312 /**
1313 * tipc_send_buf2port - send message buffer to port identity
1314 */
1315 int tipc_send_buf2port(u32 ref, struct tipc_portid const *dest,
1316 struct sk_buff *buf, unsigned int dsz)
1317 {
1318 struct tipc_port *p_ptr;
1319 struct tipc_msg *msg;
1320 int res;
1321
1322 p_ptr = (struct tipc_port *)tipc_ref_deref(ref);
1323 if (!p_ptr || p_ptr->connected)
1324 return -EINVAL;
1325
1326 msg = &p_ptr->phdr;
1327 msg_set_type(msg, TIPC_DIRECT_MSG);
1328 msg_set_destnode(msg, dest->node);
1329 msg_set_destport(msg, dest->ref);
1330 msg_set_hdr_sz(msg, BASIC_H_SIZE);
1331 msg_set_size(msg, BASIC_H_SIZE + dsz);
1332 if (skb_cow(buf, BASIC_H_SIZE))
1333 return -ENOMEM;
1334
1335 skb_push(buf, BASIC_H_SIZE);
1336 skb_copy_to_linear_data(buf, msg, BASIC_H_SIZE);
1337
1338 if (in_own_node(dest->node))
1339 res = tipc_port_recv_msg(buf);
1340 else
1341 res = tipc_send_buf_fast(buf, dest->node);
1342 if (likely(res != -ELINKCONG)) {
1343 if (res > 0)
1344 p_ptr->sent++;
1345 return res;
1346 }
1347 if (port_unreliable(p_ptr))
1348 return dsz;
1349 return -ELINKCONG;
1350 }
Linus' kernel tree