/* * net/tipc/port.c: TIPC port code * * Copyright (c) 1992-2006, Ericsson AB * Copyright (c) 2004-2005, Wind River Systems * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. Neither the names of the copyright holders nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * Alternatively, this software may be distributed under the terms of the * GNU General Public License ("GPL") version 2 as published by the Free * Software Foundation. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include "core.h" #include "config.h" #include "dbg.h" #include "port.h" #include "addr.h" #include "link.h" #include "node.h" #include "port.h" #include "name_table.h" #include "user_reg.h" #include "msg.h" #include "bcast.h" /* Connection management: */ #define PROBING_INTERVAL 3600000 /* [ms] => 1 h */ #define CONFIRMED 0 #define PROBING 1 #define MAX_REJECT_SIZE 1024 static struct sk_buff *msg_queue_head = NULL; static struct sk_buff *msg_queue_tail = NULL; spinlock_t tipc_port_list_lock = SPIN_LOCK_UNLOCKED; static spinlock_t queue_lock = SPIN_LOCK_UNLOCKED; static LIST_HEAD(ports); static void port_handle_node_down(unsigned long ref); static struct sk_buff* port_build_self_abort_msg(struct port *,u32 err); static struct sk_buff* port_build_peer_abort_msg(struct port *,u32 err); static void port_timeout(unsigned long ref); static u32 port_peernode(struct port *p_ptr) { return msg_destnode(&p_ptr->publ.phdr); } static u32 port_peerport(struct port *p_ptr) { return msg_destport(&p_ptr->publ.phdr); } static u32 port_out_seqno(struct port *p_ptr) { return msg_transp_seqno(&p_ptr->publ.phdr); } static void port_set_out_seqno(struct port *p_ptr, u32 seqno) { msg_set_transp_seqno(&p_ptr->publ.phdr,seqno); } static void port_incr_out_seqno(struct port *p_ptr) { struct tipc_msg *m = &p_ptr->publ.phdr; if (likely(!msg_routed(m))) return; msg_set_transp_seqno(m, (msg_transp_seqno(m) + 1)); } /** * tipc_multicast - send a multicast message to local and remote destinations */ int tipc_multicast(u32 ref, struct tipc_name_seq const *seq, u32 domain, u32 num_sect, struct iovec const *msg_sect) { struct tipc_msg *hdr; struct sk_buff *buf; struct sk_buff *ibuf = NULL; struct port_list dports = {0, NULL, }; struct port *oport = tipc_port_deref(ref); int ext_targets; int res; if (unlikely(!oport)) return -EINVAL; /* Create multicast message */ hdr = &oport->publ.phdr; msg_set_type(hdr, TIPC_MCAST_MSG); msg_set_nametype(hdr, seq->type); msg_set_namelower(hdr, seq->lower); msg_set_nameupper(hdr, seq->upper); msg_set_hdr_sz(hdr, MCAST_H_SIZE); res = msg_build(hdr, msg_sect, num_sect, MAX_MSG_SIZE, !oport->user_port, &buf); if (unlikely(!buf)) return res; /* Figure out where to send multicast message */ ext_targets = tipc_nametbl_mc_translate(seq->type, seq->lower, seq->upper, TIPC_NODE_SCOPE, &dports); /* Send message to destinations (duplicate it only if necessary) */ if (ext_targets) { if (dports.count != 0) { ibuf = skb_copy(buf, GFP_ATOMIC); if (ibuf == NULL) { tipc_port_list_free(&dports); buf_discard(buf); return -ENOMEM; } } res = tipc_bclink_send_msg(buf); if ((res < 0) && (dports.count != 0)) { buf_discard(ibuf); } } else { ibuf = buf; } if (res >= 0) { if (ibuf) tipc_port_recv_mcast(ibuf, &dports); } else { tipc_port_list_free(&dports); } return res; } /** * tipc_port_recv_mcast - deliver multicast message to all destination ports * * If there is no port list, perform a lookup to create one */ void tipc_port_recv_mcast(struct sk_buff *buf, struct port_list *dp) { struct tipc_msg* msg; struct port_list dports = {0, NULL, }; struct port_list *item = dp; int cnt = 0; assert(buf); msg = buf_msg(buf); /* Create destination port list, if one wasn't supplied */ if (dp == NULL) { tipc_nametbl_mc_translate(msg_nametype(msg), msg_namelower(msg), msg_nameupper(msg), TIPC_CLUSTER_SCOPE, &dports); item = dp = &dports; } /* Deliver a copy of message to each destination port */ if (dp->count != 0) { if (dp->count == 1) { msg_set_destport(msg, dp->ports[0]); tipc_port_recv_msg(buf); tipc_port_list_free(dp); return; } for (; cnt < dp->count; cnt++) { int index = cnt % PLSIZE; struct sk_buff *b = skb_clone(buf, GFP_ATOMIC); if (b == NULL) { warn("Buffer allocation failure\n"); msg_dbg(msg, "LOST:"); goto exit; } if ((index == 0) && (cnt != 0)) { item = item->next; } msg_set_destport(buf_msg(b),item->ports[index]); tipc_port_recv_msg(b); } } exit: buf_discard(buf); tipc_port_list_free(dp); } /** * tipc_createport_raw - create a native TIPC port * * Returns local port reference */ u32 tipc_createport_raw(void *usr_handle, u32 (*dispatcher)(struct tipc_port *, struct sk_buff *), void (*wakeup)(struct tipc_port *), const u32 importance) { struct port *p_ptr; struct tipc_msg *msg; u32 ref; p_ptr = kmalloc(sizeof(*p_ptr), GFP_ATOMIC); if (p_ptr == NULL) { warn("Memory squeeze; failed to create port\n"); return 0; } memset(p_ptr, 0, sizeof(*p_ptr)); ref = tipc_ref_acquire(p_ptr, &p_ptr->publ.lock); if (!ref) { warn("Reference Table Exhausted\n"); kfree(p_ptr); return 0; } tipc_port_lock(ref); p_ptr->publ.ref = ref; msg = &p_ptr->publ.phdr; msg_init(msg, DATA_LOW, TIPC_NAMED_MSG, TIPC_OK, LONG_H_SIZE, 0); msg_set_orignode(msg, tipc_own_addr); msg_set_prevnode(msg, tipc_own_addr); msg_set_origport(msg, ref); msg_set_importance(msg,importance); p_ptr->last_in_seqno = 41; p_ptr->sent = 1; p_ptr->publ.usr_handle = usr_handle; INIT_LIST_HEAD(&p_ptr->wait_list); INIT_LIST_HEAD(&p_ptr->subscription.nodesub_list); p_ptr->congested_link = NULL; p_ptr->max_pkt = MAX_PKT_DEFAULT; p_ptr->dispatcher = dispatcher; p_ptr->wakeup = wakeup; p_ptr->user_port = NULL; k_init_timer(&p_ptr->timer, (Handler)port_timeout, ref); spin_lock_bh(&tipc_port_list_lock); INIT_LIST_HEAD(&p_ptr->publications); INIT_LIST_HEAD(&p_ptr->port_list); list_add_tail(&p_ptr->port_list, &ports); spin_unlock_bh(&tipc_port_list_lock); tipc_port_unlock(p_ptr); return ref; } int tipc_deleteport(u32 ref) { struct port *p_ptr; struct sk_buff *buf = NULL; tipc_withdraw(ref, 0, NULL); p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; tipc_ref_discard(ref); tipc_port_unlock(p_ptr); k_cancel_timer(&p_ptr->timer); if (p_ptr->publ.connected) { buf = port_build_peer_abort_msg(p_ptr, TIPC_ERR_NO_PORT); tipc_nodesub_unsubscribe(&p_ptr->subscription); } if (p_ptr->user_port) { tipc_reg_remove_port(p_ptr->user_port); kfree(p_ptr->user_port); } spin_lock_bh(&tipc_port_list_lock); list_del(&p_ptr->port_list); list_del(&p_ptr->wait_list); spin_unlock_bh(&tipc_port_list_lock); k_term_timer(&p_ptr->timer); kfree(p_ptr); dbg("Deleted port %u\n", ref); tipc_net_route_msg(buf); return TIPC_OK; } /** * tipc_get_port() - return port associated with 'ref' * * Note: Port is not locked. */ struct tipc_port *tipc_get_port(const u32 ref) { return (struct tipc_port *)tipc_ref_deref(ref); } /** * tipc_get_handle - return user handle associated to port 'ref' */ void *tipc_get_handle(const u32 ref) { struct port *p_ptr; void * handle; p_ptr = tipc_port_lock(ref); if (!p_ptr) return NULL; handle = p_ptr->publ.usr_handle; tipc_port_unlock(p_ptr); return handle; } static int port_unreliable(struct port *p_ptr) { return msg_src_droppable(&p_ptr->publ.phdr); } int tipc_portunreliable(u32 ref, unsigned int *isunreliable) { struct port *p_ptr; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; *isunreliable = port_unreliable(p_ptr); spin_unlock_bh(p_ptr->publ.lock); return TIPC_OK; } int tipc_set_portunreliable(u32 ref, unsigned int isunreliable) { struct port *p_ptr; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; msg_set_src_droppable(&p_ptr->publ.phdr, (isunreliable != 0)); tipc_port_unlock(p_ptr); return TIPC_OK; } static int port_unreturnable(struct port *p_ptr) { return msg_dest_droppable(&p_ptr->publ.phdr); } int tipc_portunreturnable(u32 ref, unsigned int *isunrejectable) { struct port *p_ptr; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; *isunrejectable = port_unreturnable(p_ptr); spin_unlock_bh(p_ptr->publ.lock); return TIPC_OK; } int tipc_set_portunreturnable(u32 ref, unsigned int isunrejectable) { struct port *p_ptr; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; msg_set_dest_droppable(&p_ptr->publ.phdr, (isunrejectable != 0)); tipc_port_unlock(p_ptr); return TIPC_OK; } /* * port_build_proto_msg(): build a port level protocol * or a connection abortion message. Called with * tipc_port lock on. */ static struct sk_buff *port_build_proto_msg(u32 destport, u32 destnode, u32 origport, u32 orignode, u32 usr, u32 type, u32 err, u32 seqno, u32 ack) { struct sk_buff *buf; struct tipc_msg *msg; buf = buf_acquire(LONG_H_SIZE); if (buf) { msg = buf_msg(buf); msg_init(msg, usr, type, err, LONG_H_SIZE, destnode); msg_set_destport(msg, destport); msg_set_origport(msg, origport); msg_set_destnode(msg, destnode); msg_set_orignode(msg, orignode); msg_set_transp_seqno(msg, seqno); msg_set_msgcnt(msg, ack); msg_dbg(msg, "PORT>SEND>:"); } return buf; } int tipc_set_msg_option(struct tipc_port *tp_ptr, const char *opt, const u32 sz) { msg_expand(&tp_ptr->phdr, msg_destnode(&tp_ptr->phdr)); msg_set_options(&tp_ptr->phdr, opt, sz); return TIPC_OK; } int tipc_reject_msg(struct sk_buff *buf, u32 err) { struct tipc_msg *msg = buf_msg(buf); struct sk_buff *rbuf; struct tipc_msg *rmsg; int hdr_sz; u32 imp = msg_importance(msg); u32 data_sz = msg_data_sz(msg); if (data_sz > MAX_REJECT_SIZE) data_sz = MAX_REJECT_SIZE; if (msg_connected(msg) && (imp < TIPC_CRITICAL_IMPORTANCE)) imp++; msg_dbg(msg, "port->rej: "); /* discard rejected message if it shouldn't be returned to sender */ if (msg_errcode(msg) || msg_dest_droppable(msg)) { buf_discard(buf); return data_sz; } /* construct rejected message */ if (msg_mcast(msg)) hdr_sz = MCAST_H_SIZE; else hdr_sz = LONG_H_SIZE; rbuf = buf_acquire(data_sz + hdr_sz); if (rbuf == NULL) { buf_discard(buf); return data_sz; } rmsg = buf_msg(rbuf); msg_init(rmsg, imp, msg_type(msg), err, hdr_sz, msg_orignode(msg)); msg_set_destport(rmsg, msg_origport(msg)); msg_set_prevnode(rmsg, tipc_own_addr); msg_set_origport(rmsg, msg_destport(msg)); if (msg_short(msg)) msg_set_orignode(rmsg, tipc_own_addr); else msg_set_orignode(rmsg, msg_destnode(msg)); msg_set_size(rmsg, data_sz + hdr_sz); msg_set_nametype(rmsg, msg_nametype(msg)); msg_set_nameinst(rmsg, msg_nameinst(msg)); memcpy(rbuf->data + hdr_sz, msg_data(msg), data_sz); /* send self-abort message when rejecting on a connected port */ if (msg_connected(msg)) { struct sk_buff *abuf = NULL; struct port *p_ptr = tipc_port_lock(msg_destport(msg)); if (p_ptr) { if (p_ptr->publ.connected) abuf = port_build_self_abort_msg(p_ptr, err); tipc_port_unlock(p_ptr); } tipc_net_route_msg(abuf); } /* send rejected message */ buf_discard(buf); tipc_net_route_msg(rbuf); return data_sz; } int tipc_port_reject_sections(struct port *p_ptr, struct tipc_msg *hdr, struct iovec const *msg_sect, u32 num_sect, int err) { struct sk_buff *buf; int res; res = msg_build(hdr, msg_sect, num_sect, MAX_MSG_SIZE, !p_ptr->user_port, &buf); if (!buf) return res; return tipc_reject_msg(buf, err); } static void port_timeout(unsigned long ref) { struct port *p_ptr = tipc_port_lock(ref); struct sk_buff *buf = NULL; if (!p_ptr || !p_ptr->publ.connected) return; /* Last probe answered ? */ if (p_ptr->probing_state == PROBING) { buf = port_build_self_abort_msg(p_ptr, TIPC_ERR_NO_PORT); } else { buf = port_build_proto_msg(port_peerport(p_ptr), port_peernode(p_ptr), p_ptr->publ.ref, tipc_own_addr, CONN_MANAGER, CONN_PROBE, TIPC_OK, port_out_seqno(p_ptr), 0); port_incr_out_seqno(p_ptr); p_ptr->probing_state = PROBING; k_start_timer(&p_ptr->timer, p_ptr->probing_interval); } tipc_port_unlock(p_ptr); tipc_net_route_msg(buf); } static void port_handle_node_down(unsigned long ref) { struct port *p_ptr = tipc_port_lock(ref); struct sk_buff* buf = NULL; if (!p_ptr) return; buf = port_build_self_abort_msg(p_ptr, TIPC_ERR_NO_NODE); tipc_port_unlock(p_ptr); tipc_net_route_msg(buf); } static struct sk_buff *port_build_self_abort_msg(struct port *p_ptr, u32 err) { u32 imp = msg_importance(&p_ptr->publ.phdr); if (!p_ptr->publ.connected) return NULL; if (imp < TIPC_CRITICAL_IMPORTANCE) imp++; return port_build_proto_msg(p_ptr->publ.ref, tipc_own_addr, port_peerport(p_ptr), port_peernode(p_ptr), imp, TIPC_CONN_MSG, err, p_ptr->last_in_seqno + 1, 0); } static struct sk_buff *port_build_peer_abort_msg(struct port *p_ptr, u32 err) { u32 imp = msg_importance(&p_ptr->publ.phdr); if (!p_ptr->publ.connected) return NULL; if (imp < TIPC_CRITICAL_IMPORTANCE) imp++; return port_build_proto_msg(port_peerport(p_ptr), port_peernode(p_ptr), p_ptr->publ.ref, tipc_own_addr, imp, TIPC_CONN_MSG, err, port_out_seqno(p_ptr), 0); } void tipc_port_recv_proto_msg(struct sk_buff *buf) { struct tipc_msg *msg = buf_msg(buf); struct port *p_ptr = tipc_port_lock(msg_destport(msg)); u32 err = TIPC_OK; struct sk_buff *r_buf = NULL; struct sk_buff *abort_buf = NULL; msg_dbg(msg, "PORTpubl.connected) { if (port_peernode(p_ptr) != msg_orignode(msg)) err = TIPC_ERR_NO_PORT; if (port_peerport(p_ptr) != msg_origport(msg)) err = TIPC_ERR_NO_PORT; if (!err && msg_routed(msg)) { u32 seqno = msg_transp_seqno(msg); u32 myno = ++p_ptr->last_in_seqno; if (seqno != myno) { err = TIPC_ERR_NO_PORT; abort_buf = port_build_self_abort_msg(p_ptr, err); } } if (msg_type(msg) == CONN_ACK) { int wakeup = tipc_port_congested(p_ptr) && p_ptr->publ.congested && p_ptr->wakeup; p_ptr->acked += msg_msgcnt(msg); if (tipc_port_congested(p_ptr)) goto exit; p_ptr->publ.congested = 0; if (!wakeup) goto exit; p_ptr->wakeup(&p_ptr->publ); goto exit; } } else if (p_ptr->publ.published) { err = TIPC_ERR_NO_PORT; } if (err) { r_buf = port_build_proto_msg(msg_origport(msg), msg_orignode(msg), msg_destport(msg), tipc_own_addr, DATA_HIGH, TIPC_CONN_MSG, err, 0, 0); goto exit; } /* All is fine */ if (msg_type(msg) == CONN_PROBE) { r_buf = port_build_proto_msg(msg_origport(msg), msg_orignode(msg), msg_destport(msg), tipc_own_addr, CONN_MANAGER, CONN_PROBE_REPLY, TIPC_OK, port_out_seqno(p_ptr), 0); } p_ptr->probing_state = CONFIRMED; port_incr_out_seqno(p_ptr); exit: if (p_ptr) tipc_port_unlock(p_ptr); tipc_net_route_msg(r_buf); tipc_net_route_msg(abort_buf); buf_discard(buf); } static void port_print(struct port *p_ptr, struct print_buf *buf, int full_id) { struct publication *publ; if (full_id) tipc_printf(buf, "<%u.%u.%u:%u>:", tipc_zone(tipc_own_addr), tipc_cluster(tipc_own_addr), tipc_node(tipc_own_addr), p_ptr->publ.ref); else tipc_printf(buf, "%-10u:", p_ptr->publ.ref); if (p_ptr->publ.connected) { u32 dport = port_peerport(p_ptr); u32 destnode = port_peernode(p_ptr); tipc_printf(buf, " connected to <%u.%u.%u:%u>", tipc_zone(destnode), tipc_cluster(destnode), tipc_node(destnode), dport); if (p_ptr->publ.conn_type != 0) tipc_printf(buf, " via {%u,%u}", p_ptr->publ.conn_type, p_ptr->publ.conn_instance); } else if (p_ptr->publ.published) { tipc_printf(buf, " bound to"); list_for_each_entry(publ, &p_ptr->publications, pport_list) { if (publ->lower == publ->upper) tipc_printf(buf, " {%u,%u}", publ->type, publ->lower); else tipc_printf(buf, " {%u,%u,%u}", publ->type, publ->lower, publ->upper); } } tipc_printf(buf, "\n"); } #define MAX_PORT_QUERY 32768 struct sk_buff *tipc_port_get_ports(void) { struct sk_buff *buf; struct tlv_desc *rep_tlv; struct print_buf pb; struct port *p_ptr; int str_len; buf = tipc_cfg_reply_alloc(TLV_SPACE(MAX_PORT_QUERY)); if (!buf) return NULL; rep_tlv = (struct tlv_desc *)buf->data; tipc_printbuf_init(&pb, TLV_DATA(rep_tlv), MAX_PORT_QUERY); spin_lock_bh(&tipc_port_list_lock); list_for_each_entry(p_ptr, &ports, port_list) { spin_lock_bh(p_ptr->publ.lock); port_print(p_ptr, &pb, 0); spin_unlock_bh(p_ptr->publ.lock); } spin_unlock_bh(&tipc_port_list_lock); str_len = tipc_printbuf_validate(&pb); skb_put(buf, TLV_SPACE(str_len)); TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len); return buf; } #if 0 #define MAX_PORT_STATS 2000 struct sk_buff *port_show_stats(const void *req_tlv_area, int req_tlv_space) { u32 ref; struct port *p_ptr; struct sk_buff *buf; struct tlv_desc *rep_tlv; struct print_buf pb; int str_len; if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_PORT_REF)) return cfg_reply_error_string(TIPC_CFG_TLV_ERROR); ref = *(u32 *)TLV_DATA(req_tlv_area); ref = ntohl(ref); p_ptr = tipc_port_lock(ref); if (!p_ptr) return cfg_reply_error_string("port not found"); buf = tipc_cfg_reply_alloc(TLV_SPACE(MAX_PORT_STATS)); if (!buf) { tipc_port_unlock(p_ptr); return NULL; } rep_tlv = (struct tlv_desc *)buf->data; tipc_printbuf_init(&pb, TLV_DATA(rep_tlv), MAX_PORT_STATS); port_print(p_ptr, &pb, 1); /* NEED TO FILL IN ADDITIONAL PORT STATISTICS HERE */ tipc_port_unlock(p_ptr); str_len = tipc_printbuf_validate(&pb); skb_put(buf, TLV_SPACE(str_len)); TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len); return buf; } #endif void tipc_port_reinit(void) { struct port *p_ptr; struct tipc_msg *msg; spin_lock_bh(&tipc_port_list_lock); list_for_each_entry(p_ptr, &ports, port_list) { msg = &p_ptr->publ.phdr; if (msg_orignode(msg) == tipc_own_addr) break; msg_set_orignode(msg, tipc_own_addr); } spin_unlock_bh(&tipc_port_list_lock); } /* * port_dispatcher_sigh(): Signal handler for messages destinated * to the tipc_port interface. */ static void port_dispatcher_sigh(void *dummy) { struct sk_buff *buf; spin_lock_bh(&queue_lock); buf = msg_queue_head; msg_queue_head = NULL; spin_unlock_bh(&queue_lock); while (buf) { struct port *p_ptr; struct user_port *up_ptr; struct tipc_portid orig; struct tipc_name_seq dseq; void *usr_handle; int connected; int published; struct sk_buff *next = buf->next; struct tipc_msg *msg = buf_msg(buf); u32 dref = msg_destport(msg); p_ptr = tipc_port_lock(dref); if (!p_ptr) { /* Port deleted while msg in queue */ tipc_reject_msg(buf, TIPC_ERR_NO_PORT); buf = next; continue; } orig.ref = msg_origport(msg); orig.node = msg_orignode(msg); up_ptr = p_ptr->user_port; usr_handle = up_ptr->usr_handle; connected = p_ptr->publ.connected; published = p_ptr->publ.published; if (unlikely(msg_errcode(msg))) goto err; switch (msg_type(msg)) { case TIPC_CONN_MSG:{ tipc_conn_msg_event cb = up_ptr->conn_msg_cb; u32 peer_port = port_peerport(p_ptr); u32 peer_node = port_peernode(p_ptr); spin_unlock_bh(p_ptr->publ.lock); if (unlikely(!connected)) { if (unlikely(published)) goto reject; tipc_connect2port(dref,&orig); } if (unlikely(msg_origport(msg) != peer_port)) goto reject; if (unlikely(msg_orignode(msg) != peer_node)) goto reject; if (unlikely(!cb)) goto reject; if (unlikely(++p_ptr->publ.conn_unacked >= TIPC_FLOW_CONTROL_WIN)) tipc_acknowledge(dref, p_ptr->publ.conn_unacked); skb_pull(buf, msg_hdr_sz(msg)); cb(usr_handle, dref, &buf, msg_data(msg), msg_data_sz(msg)); break; } case TIPC_DIRECT_MSG:{ tipc_msg_event cb = up_ptr->msg_cb; spin_unlock_bh(p_ptr->publ.lock); if (unlikely(connected)) goto reject; if (unlikely(!cb)) goto reject; skb_pull(buf, msg_hdr_sz(msg)); cb(usr_handle, dref, &buf, msg_data(msg), msg_data_sz(msg), msg_importance(msg), &orig); break; } case TIPC_NAMED_MSG:{ tipc_named_msg_event cb = up_ptr->named_msg_cb; spin_unlock_bh(p_ptr->publ.lock); if (unlikely(connected)) goto reject; if (unlikely(!cb)) goto reject; if (unlikely(!published)) goto reject; dseq.type = msg_nametype(msg); dseq.lower = msg_nameinst(msg); dseq.upper = dseq.lower; skb_pull(buf, msg_hdr_sz(msg)); cb(usr_handle, dref, &buf, msg_data(msg), msg_data_sz(msg), msg_importance(msg), &orig, &dseq); break; } } if (buf) buf_discard(buf); buf = next; continue; err: switch (msg_type(msg)) { case TIPC_CONN_MSG:{ tipc_conn_shutdown_event cb = up_ptr->conn_err_cb; u32 peer_port = port_peerport(p_ptr); u32 peer_node = port_peernode(p_ptr); spin_unlock_bh(p_ptr->publ.lock); if (!connected || !cb) break; if (msg_origport(msg) != peer_port) break; if (msg_orignode(msg) != peer_node) break; tipc_disconnect(dref); skb_pull(buf, msg_hdr_sz(msg)); cb(usr_handle, dref, &buf, msg_data(msg), msg_data_sz(msg), msg_errcode(msg)); break; } case TIPC_DIRECT_MSG:{ tipc_msg_err_event cb = up_ptr->err_cb; spin_unlock_bh(p_ptr->publ.lock); if (connected || !cb) break; skb_pull(buf, msg_hdr_sz(msg)); cb(usr_handle, dref, &buf, msg_data(msg), msg_data_sz(msg), msg_errcode(msg), &orig); break; } case TIPC_NAMED_MSG:{ tipc_named_msg_err_event cb = up_ptr->named_err_cb; spin_unlock_bh(p_ptr->publ.lock); if (connected || !cb) break; dseq.type = msg_nametype(msg); dseq.lower = msg_nameinst(msg); dseq.upper = dseq.lower; skb_pull(buf, msg_hdr_sz(msg)); cb(usr_handle, dref, &buf, msg_data(msg), msg_data_sz(msg), msg_errcode(msg), &dseq); break; } } if (buf) buf_discard(buf); buf = next; continue; reject: tipc_reject_msg(buf, TIPC_ERR_NO_PORT); buf = next; } } /* * port_dispatcher(): Dispatcher for messages destinated * to the tipc_port interface. Called with port locked. */ static u32 port_dispatcher(struct tipc_port *dummy, struct sk_buff *buf) { buf->next = NULL; spin_lock_bh(&queue_lock); if (msg_queue_head) { msg_queue_tail->next = buf; msg_queue_tail = buf; } else { msg_queue_tail = msg_queue_head = buf; tipc_k_signal((Handler)port_dispatcher_sigh, 0); } spin_unlock_bh(&queue_lock); return TIPC_OK; } /* * Wake up port after congestion: Called with port locked, * */ static void port_wakeup_sh(unsigned long ref) { struct port *p_ptr; struct user_port *up_ptr; tipc_continue_event cb = NULL; void *uh = NULL; p_ptr = tipc_port_lock(ref); if (p_ptr) { up_ptr = p_ptr->user_port; if (up_ptr) { cb = up_ptr->continue_event_cb; uh = up_ptr->usr_handle; } tipc_port_unlock(p_ptr); } if (cb) cb(uh, ref); } static void port_wakeup(struct tipc_port *p_ptr) { tipc_k_signal((Handler)port_wakeup_sh, p_ptr->ref); } void tipc_acknowledge(u32 ref, u32 ack) { struct port *p_ptr; struct sk_buff *buf = NULL; p_ptr = tipc_port_lock(ref); if (!p_ptr) return; if (p_ptr->publ.connected) { p_ptr->publ.conn_unacked -= ack; buf = port_build_proto_msg(port_peerport(p_ptr), port_peernode(p_ptr), ref, tipc_own_addr, CONN_MANAGER, CONN_ACK, TIPC_OK, port_out_seqno(p_ptr), ack); } tipc_port_unlock(p_ptr); tipc_net_route_msg(buf); } /* * tipc_createport(): user level call. Will add port to * registry if non-zero user_ref. */ int tipc_createport(u32 user_ref, void *usr_handle, unsigned int importance, tipc_msg_err_event error_cb, tipc_named_msg_err_event named_error_cb, tipc_conn_shutdown_event conn_error_cb, tipc_msg_event msg_cb, tipc_named_msg_event named_msg_cb, tipc_conn_msg_event conn_msg_cb, tipc_continue_event continue_event_cb,/* May be zero */ u32 *portref) { struct user_port *up_ptr; struct port *p_ptr; u32 ref; up_ptr = (struct user_port *)kmalloc(sizeof(*up_ptr), GFP_ATOMIC); if (up_ptr == NULL) { return -ENOMEM; } ref = tipc_createport_raw(NULL, port_dispatcher, port_wakeup, importance); p_ptr = tipc_port_lock(ref); if (!p_ptr) { kfree(up_ptr); return -ENOMEM; } p_ptr->user_port = up_ptr; up_ptr->user_ref = user_ref; up_ptr->usr_handle = usr_handle; up_ptr->ref = p_ptr->publ.ref; up_ptr->err_cb = error_cb; up_ptr->named_err_cb = named_error_cb; up_ptr->conn_err_cb = conn_error_cb; up_ptr->msg_cb = msg_cb; up_ptr->named_msg_cb = named_msg_cb; up_ptr->conn_msg_cb = conn_msg_cb; up_ptr->continue_event_cb = continue_event_cb; INIT_LIST_HEAD(&up_ptr->uport_list); tipc_reg_add_port(up_ptr); *portref = p_ptr->publ.ref; dbg(" tipc_createport: %x with ref %u\n", p_ptr, p_ptr->publ.ref); tipc_port_unlock(p_ptr); return TIPC_OK; } int tipc_ownidentity(u32 ref, struct tipc_portid *id) { id->ref = ref; id->node = tipc_own_addr; return TIPC_OK; } int tipc_portimportance(u32 ref, unsigned int *importance) { struct port *p_ptr; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; *importance = (unsigned int)msg_importance(&p_ptr->publ.phdr); spin_unlock_bh(p_ptr->publ.lock); return TIPC_OK; } int tipc_set_portimportance(u32 ref, unsigned int imp) { struct port *p_ptr; if (imp > TIPC_CRITICAL_IMPORTANCE) return -EINVAL; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; msg_set_importance(&p_ptr->publ.phdr, (u32)imp); spin_unlock_bh(p_ptr->publ.lock); return TIPC_OK; } int tipc_publish(u32 ref, unsigned int scope, struct tipc_name_seq const *seq) { struct port *p_ptr; struct publication *publ; u32 key; int res = -EINVAL; p_ptr = tipc_port_lock(ref); dbg("tipc_publ %u, p_ptr = %x, conn = %x, scope = %x, " "lower = %u, upper = %u\n", ref, p_ptr, p_ptr->publ.connected, scope, seq->lower, seq->upper); if (!p_ptr) return -EINVAL; if (p_ptr->publ.connected) goto exit; if (seq->lower > seq->upper) goto exit; if ((scope < TIPC_ZONE_SCOPE) || (scope > TIPC_NODE_SCOPE)) goto exit; key = ref + p_ptr->pub_count + 1; if (key == ref) { res = -EADDRINUSE; goto exit; } publ = tipc_nametbl_publish(seq->type, seq->lower, seq->upper, scope, p_ptr->publ.ref, key); if (publ) { list_add(&publ->pport_list, &p_ptr->publications); p_ptr->pub_count++; p_ptr->publ.published = 1; res = TIPC_OK; } exit: tipc_port_unlock(p_ptr); return res; } int tipc_withdraw(u32 ref, unsigned int scope, struct tipc_name_seq const *seq) { struct port *p_ptr; struct publication *publ; struct publication *tpubl; int res = -EINVAL; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; if (!p_ptr->publ.published) goto exit; if (!seq) { list_for_each_entry_safe(publ, tpubl, &p_ptr->publications, pport_list) { tipc_nametbl_withdraw(publ->type, publ->lower, publ->ref, publ->key); } res = TIPC_OK; } else { list_for_each_entry_safe(publ, tpubl, &p_ptr->publications, pport_list) { if (publ->scope != scope) continue; if (publ->type != seq->type) continue; if (publ->lower != seq->lower) continue; if (publ->upper != seq->upper) break; tipc_nametbl_withdraw(publ->type, publ->lower, publ->ref, publ->key); res = TIPC_OK; break; } } if (list_empty(&p_ptr->publications)) p_ptr->publ.published = 0; exit: tipc_port_unlock(p_ptr); return res; } int tipc_connect2port(u32 ref, struct tipc_portid const *peer) { struct port *p_ptr; struct tipc_msg *msg; int res = -EINVAL; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; if (p_ptr->publ.published || p_ptr->publ.connected) goto exit; if (!peer->ref) goto exit; msg = &p_ptr->publ.phdr; msg_set_destnode(msg, peer->node); msg_set_destport(msg, peer->ref); msg_set_orignode(msg, tipc_own_addr); msg_set_origport(msg, p_ptr->publ.ref); msg_set_transp_seqno(msg, 42); msg_set_type(msg, TIPC_CONN_MSG); if (!may_route(peer->node)) msg_set_hdr_sz(msg, SHORT_H_SIZE); else msg_set_hdr_sz(msg, LONG_H_SIZE); p_ptr->probing_interval = PROBING_INTERVAL; p_ptr->probing_state = CONFIRMED; p_ptr->publ.connected = 1; k_start_timer(&p_ptr->timer, p_ptr->probing_interval); tipc_nodesub_subscribe(&p_ptr->subscription,peer->node, (void *)(unsigned long)ref, (net_ev_handler)port_handle_node_down); res = TIPC_OK; exit: tipc_port_unlock(p_ptr); p_ptr->max_pkt = tipc_link_get_max_pkt(peer->node, ref); return res; } /* * tipc_disconnect(): Disconnect port form peer. * This is a node local operation. */ int tipc_disconnect(u32 ref) { struct port *p_ptr; int res = -ENOTCONN; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; if (p_ptr->publ.connected) { p_ptr->publ.connected = 0; /* let timer expire on it's own to avoid deadlock! */ tipc_nodesub_unsubscribe(&p_ptr->subscription); res = TIPC_OK; } tipc_port_unlock(p_ptr); return res; } /* * tipc_shutdown(): Send a SHUTDOWN msg to peer and disconnect */ int tipc_shutdown(u32 ref) { struct port *p_ptr; struct sk_buff *buf = NULL; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; if (p_ptr->publ.connected) { u32 imp = msg_importance(&p_ptr->publ.phdr); if (imp < TIPC_CRITICAL_IMPORTANCE) imp++; buf = port_build_proto_msg(port_peerport(p_ptr), port_peernode(p_ptr), ref, tipc_own_addr, imp, TIPC_CONN_MSG, TIPC_CONN_SHUTDOWN, port_out_seqno(p_ptr), 0); } tipc_port_unlock(p_ptr); tipc_net_route_msg(buf); return tipc_disconnect(ref); } int tipc_isconnected(u32 ref, int *isconnected) { struct port *p_ptr; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; *isconnected = p_ptr->publ.connected; tipc_port_unlock(p_ptr); return TIPC_OK; } int tipc_peer(u32 ref, struct tipc_portid *peer) { struct port *p_ptr; int res; p_ptr = tipc_port_lock(ref); if (!p_ptr) return -EINVAL; if (p_ptr->publ.connected) { peer->ref = port_peerport(p_ptr); peer->node = port_peernode(p_ptr); res = TIPC_OK; } else res = -ENOTCONN; tipc_port_unlock(p_ptr); return res; } int tipc_ref_valid(u32 ref) { /* Works irrespective of type */ return !!tipc_ref_deref(ref); } /* * tipc_port_recv_sections(): Concatenate and deliver sectioned * message for this node. */ int tipc_port_recv_sections(struct port *sender, unsigned int num_sect, struct iovec const *msg_sect) { struct sk_buff *buf; int res; res = msg_build(&sender->publ.phdr, msg_sect, num_sect, MAX_MSG_SIZE, !sender->user_port, &buf); if (likely(buf)) tipc_port_recv_msg(buf); return res; } /** * tipc_send - send message sections on connection */ int tipc_send(u32 ref, unsigned int num_sect, struct iovec const *msg_sect) { struct port *p_ptr; u32 destnode; int res; p_ptr = tipc_port_deref(ref); if (!p_ptr || !p_ptr->publ.connected) return -EINVAL; p_ptr->publ.congested = 1; if (!tipc_port_congested(p_ptr)) { destnode = port_peernode(p_ptr); if (likely(destnode != tipc_own_addr)) res = tipc_link_send_sections_fast(p_ptr, msg_sect, num_sect, destnode); else res = tipc_port_recv_sections(p_ptr, num_sect, msg_sect); if (likely(res != -ELINKCONG)) { port_incr_out_seqno(p_ptr); p_ptr->publ.congested = 0; p_ptr->sent++; return res; } } if (port_unreliable(p_ptr)) { p_ptr->publ.congested = 0; /* Just calculate msg length and return */ return msg_calc_data_size(msg_sect, num_sect); } return -ELINKCONG; } /** * tipc_send_buf - send message buffer on connection */ int tipc_send_buf(u32 ref, struct sk_buff *buf, unsigned int dsz) { struct port *p_ptr; struct tipc_msg *msg; u32 destnode; u32 hsz; u32 sz; u32 res; p_ptr = tipc_port_deref(ref); if (!p_ptr || !p_ptr->publ.connected) return -EINVAL; msg = &p_ptr->publ.phdr; hsz = msg_hdr_sz(msg); sz = hsz + dsz; msg_set_size(msg, sz); if (skb_cow(buf, hsz)) return -ENOMEM; skb_push(buf, hsz); memcpy(buf->data, (unchar *)msg, hsz); destnode = msg_destnode(msg); p_ptr->publ.congested = 1; if (!tipc_port_congested(p_ptr)) { if (likely(destnode != tipc_own_addr)) res = tipc_send_buf_fast(buf, destnode); else { tipc_port_recv_msg(buf); res = sz; } if (likely(res != -ELINKCONG)) { port_incr_out_seqno(p_ptr); p_ptr->sent++; p_ptr->publ.congested = 0; return res; } } if (port_unreliable(p_ptr)) { p_ptr->publ.congested = 0; return dsz; } return -ELINKCONG; } /** * tipc_forward2name - forward message sections to port name */ int tipc_forward2name(u32 ref, struct tipc_name const *name, u32 domain, u32 num_sect, struct iovec const *msg_sect, struct tipc_portid const *orig, unsigned int importance) { struct port *p_ptr; struct tipc_msg *msg; u32 destnode = domain; u32 destport = 0; int res; p_ptr = tipc_port_deref(ref); if (!p_ptr || p_ptr->publ.connected) return -EINVAL; msg = &p_ptr->publ.phdr; msg_set_type(msg, TIPC_NAMED_MSG); msg_set_orignode(msg, orig->node); msg_set_origport(msg, orig->ref); msg_set_hdr_sz(msg, LONG_H_SIZE); msg_set_nametype(msg, name->type); msg_set_nameinst(msg, name->instance); msg_set_lookup_scope(msg, addr_scope(domain)); if (importance <= TIPC_CRITICAL_IMPORTANCE) msg_set_importance(msg,importance); destport = tipc_nametbl_translate(name->type, name->instance, &destnode); msg_set_destnode(msg, destnode); msg_set_destport(msg, destport); if (likely(destport || destnode)) { p_ptr->sent++; if (likely(destnode == tipc_own_addr)) return tipc_port_recv_sections(p_ptr, num_sect, msg_sect); res = tipc_link_send_sections_fast(p_ptr, msg_sect, num_sect, destnode); if (likely(res != -ELINKCONG)) return res; if (port_unreliable(p_ptr)) { /* Just calculate msg length and return */ return msg_calc_data_size(msg_sect, num_sect); } return -ELINKCONG; } return tipc_port_reject_sections(p_ptr, msg, msg_sect, num_sect, TIPC_ERR_NO_NAME); } /** * tipc_send2name - send message sections to port name */ int tipc_send2name(u32 ref, struct tipc_name const *name, unsigned int domain, unsigned int num_sect, struct iovec const *msg_sect) { struct tipc_portid orig; orig.ref = ref; orig.node = tipc_own_addr; return tipc_forward2name(ref, name, domain, num_sect, msg_sect, &orig, TIPC_PORT_IMPORTANCE); } /** * tipc_forward_buf2name - forward message buffer to port name */ int tipc_forward_buf2name(u32 ref, struct tipc_name const *name, u32 domain, struct sk_buff *buf, unsigned int dsz, struct tipc_portid const *orig, unsigned int importance) { struct port *p_ptr; struct tipc_msg *msg; u32 destnode = domain; u32 destport = 0; int res; p_ptr = (struct port *)tipc_ref_deref(ref); if (!p_ptr || p_ptr->publ.connected) return -EINVAL; msg = &p_ptr->publ.phdr; if (importance <= TIPC_CRITICAL_IMPORTANCE) msg_set_importance(msg, importance); msg_set_type(msg, TIPC_NAMED_MSG); msg_set_orignode(msg, orig->node); msg_set_origport(msg, orig->ref); msg_set_nametype(msg, name->type); msg_set_nameinst(msg, name->instance); msg_set_lookup_scope(msg, addr_scope(domain)); msg_set_hdr_sz(msg, LONG_H_SIZE); msg_set_size(msg, LONG_H_SIZE + dsz); destport = tipc_nametbl_translate(name->type, name->instance, &destnode); msg_set_destnode(msg, destnode); msg_set_destport(msg, destport); msg_dbg(msg, "forw2name ==> "); if (skb_cow(buf, LONG_H_SIZE)) return -ENOMEM; skb_push(buf, LONG_H_SIZE); memcpy(buf->data, (unchar *)msg, LONG_H_SIZE); msg_dbg(buf_msg(buf),"PREP:"); if (likely(destport || destnode)) { p_ptr->sent++; if (destnode == tipc_own_addr) return tipc_port_recv_msg(buf); res = tipc_send_buf_fast(buf, destnode); if (likely(res != -ELINKCONG)) return res; if (port_unreliable(p_ptr)) return dsz; return -ELINKCONG; } return tipc_reject_msg(buf, TIPC_ERR_NO_NAME); } /** * tipc_send_buf2name - send message buffer to port name */ int tipc_send_buf2name(u32 ref, struct tipc_name const *dest, u32 domain, struct sk_buff *buf, unsigned int dsz) { struct tipc_portid orig; orig.ref = ref; orig.node = tipc_own_addr; return tipc_forward_buf2name(ref, dest, domain, buf, dsz, &orig, TIPC_PORT_IMPORTANCE); } /** * tipc_forward2port - forward message sections to port identity */ int tipc_forward2port(u32 ref, struct tipc_portid const *dest, unsigned int num_sect, struct iovec const *msg_sect, struct tipc_portid const *orig, unsigned int importance) { struct port *p_ptr; struct tipc_msg *msg; int res; p_ptr = tipc_port_deref(ref); if (!p_ptr || p_ptr->publ.connected) return -EINVAL; msg = &p_ptr->publ.phdr; msg_set_type(msg, TIPC_DIRECT_MSG); msg_set_orignode(msg, orig->node); msg_set_origport(msg, orig->ref); msg_set_destnode(msg, dest->node); msg_set_destport(msg, dest->ref); msg_set_hdr_sz(msg, DIR_MSG_H_SIZE); if (importance <= TIPC_CRITICAL_IMPORTANCE) msg_set_importance(msg, importance); p_ptr->sent++; if (dest->node == tipc_own_addr) return tipc_port_recv_sections(p_ptr, num_sect, msg_sect); res = tipc_link_send_sections_fast(p_ptr, msg_sect, num_sect, dest->node); if (likely(res != -ELINKCONG)) return res; if (port_unreliable(p_ptr)) { /* Just calculate msg length and return */ return msg_calc_data_size(msg_sect, num_sect); } return -ELINKCONG; } /** * tipc_send2port - send message sections to port identity */ int tipc_send2port(u32 ref, struct tipc_portid const *dest, unsigned int num_sect, struct iovec const *msg_sect) { struct tipc_portid orig; orig.ref = ref; orig.node = tipc_own_addr; return tipc_forward2port(ref, dest, num_sect, msg_sect, &orig, TIPC_PORT_IMPORTANCE); } /** * tipc_forward_buf2port - forward message buffer to port identity */ int tipc_forward_buf2port(u32 ref, struct tipc_portid const *dest, struct sk_buff *buf, unsigned int dsz, struct tipc_portid const *orig, unsigned int importance) { struct port *p_ptr; struct tipc_msg *msg; int res; p_ptr = (struct port *)tipc_ref_deref(ref); if (!p_ptr || p_ptr->publ.connected) return -EINVAL; msg = &p_ptr->publ.phdr; msg_set_type(msg, TIPC_DIRECT_MSG); msg_set_orignode(msg, orig->node); msg_set_origport(msg, orig->ref); msg_set_destnode(msg, dest->node); msg_set_destport(msg, dest->ref); msg_set_hdr_sz(msg, DIR_MSG_H_SIZE); if (importance <= TIPC_CRITICAL_IMPORTANCE) msg_set_importance(msg, importance); msg_set_size(msg, DIR_MSG_H_SIZE + dsz); if (skb_cow(buf, DIR_MSG_H_SIZE)) return -ENOMEM; skb_push(buf, DIR_MSG_H_SIZE); memcpy(buf->data, (unchar *)msg, DIR_MSG_H_SIZE); msg_dbg(msg, "buf2port: "); p_ptr->sent++; if (dest->node == tipc_own_addr) return tipc_port_recv_msg(buf); res = tipc_send_buf_fast(buf, dest->node); if (likely(res != -ELINKCONG)) return res; if (port_unreliable(p_ptr)) return dsz; return -ELINKCONG; } /** * tipc_send_buf2port - send message buffer to port identity */ int tipc_send_buf2port(u32 ref, struct tipc_portid const *dest, struct sk_buff *buf, unsigned int dsz) { struct tipc_portid orig; orig.ref = ref; orig.node = tipc_own_addr; return tipc_forward_buf2port(ref, dest, buf, dsz, &orig, TIPC_PORT_IMPORTANCE); }