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