12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706 |
- /*
- * net/tipc/port.c: TIPC port code
- *
- * Copyright (c) 1992-2007, Ericsson AB
- * Copyright (c) 2004-2008, 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 "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;
- DEFINE_SPINLOCK(tipc_port_list_lock);
- static DEFINE_SPINLOCK(queue_lock);
- 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_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;
- 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("Unable to deliver multicast message(s)\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 generic TIPC port
- *
- * Returns pointer to (locked) TIPC port, or NULL if unable to create it
- */
- struct tipc_port *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 = kzalloc(sizeof(*p_ptr), GFP_ATOMIC);
- if (!p_ptr) {
- warn("Port creation failed, no memory\n");
- return NULL;
- }
- ref = tipc_ref_acquire(p_ptr, &p_ptr->publ.lock);
- if (!ref) {
- warn("Port creation failed, reference table exhausted\n");
- kfree(p_ptr);
- return NULL;
- }
- p_ptr->publ.usr_handle = usr_handle;
- p_ptr->publ.max_pkt = MAX_PKT_DEFAULT;
- p_ptr->publ.ref = ref;
- msg = &p_ptr->publ.phdr;
- msg_init(msg, importance, TIPC_NAMED_MSG, LONG_H_SIZE, 0);
- msg_set_origport(msg, ref);
- p_ptr->last_in_seqno = 41;
- p_ptr->sent = 1;
- INIT_LIST_HEAD(&p_ptr->wait_list);
- INIT_LIST_HEAD(&p_ptr->subscription.nodesub_list);
- p_ptr->congested_link = NULL;
- 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);
- return &(p_ptr->publ);
- }
- 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 0;
- }
- /**
- * 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);
- tipc_port_unlock(p_ptr);
- return 0;
- }
- 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 0;
- }
- 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);
- tipc_port_unlock(p_ptr);
- return 0;
- }
- 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 0;
- }
- /*
- * 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, LONG_H_SIZE, destnode);
- msg_set_errcode(msg, err);
- msg_set_destport(msg, destport);
- msg_set_origport(msg, origport);
- 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_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), hdr_sz, msg_orignode(msg));
- msg_set_errcode(rmsg, err);
- msg_set_destport(rmsg, msg_origport(msg));
- msg_set_origport(rmsg, msg_destport(msg));
- if (msg_short(msg)) {
- msg_set_orignode(rmsg, tipc_own_addr);
- /* leave name type & instance as zeroes */
- } else {
- msg_set_orignode(rmsg, msg_destnode(msg));
- msg_set_nametype(rmsg, msg_nametype(msg));
- msg_set_nameinst(rmsg, msg_nameinst(msg));
- }
- msg_set_size(rmsg, data_sz + hdr_sz);
- skb_copy_to_linear_data_offset(rbuf, 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)
- return;
- if (!p_ptr->publ.connected) {
- tipc_port_unlock(p_ptr);
- 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, "PORT<RECV<:");
- if (!p_ptr) {
- err = TIPC_ERR_NO_PORT;
- } else if (p_ptr->publ.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,
- TIPC_HIGH_IMPORTANCE,
- 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_prevnode(msg, tipc_own_addr);
- 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;
- u32 message_type;
- struct sk_buff *next = buf->next;
- struct tipc_msg *msg = buf_msg(buf);
- u32 dref = msg_destport(msg);
- message_type = msg_type(msg);
- if (message_type > TIPC_DIRECT_MSG)
- goto reject; /* Unsupported message type */
- p_ptr = tipc_port_lock(dref);
- if (!p_ptr)
- goto reject; /* Port deleted while msg in queue */
- 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 (message_type) {
- 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);
- tipc_port_unlock(p_ptr);
- if (unlikely(!cb))
- goto reject;
- if (unlikely(!connected)) {
- if (tipc_connect2port(dref, &orig))
- goto reject;
- } else if ((msg_origport(msg) != peer_port) ||
- (msg_orignode(msg) != peer_node))
- 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;
- tipc_port_unlock(p_ptr);
- if (unlikely(!cb || connected))
- 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_MCAST_MSG:
- case TIPC_NAMED_MSG:{
- tipc_named_msg_event cb = up_ptr->named_msg_cb;
- tipc_port_unlock(p_ptr);
- if (unlikely(!cb || connected || !published))
- goto reject;
- dseq.type = msg_nametype(msg);
- dseq.lower = msg_nameinst(msg);
- dseq.upper = (message_type == TIPC_NAMED_MSG)
- ? dseq.lower : msg_nameupper(msg);
- 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 (message_type) {
- 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);
- tipc_port_unlock(p_ptr);
- if (!cb || !connected)
- break;
- if ((msg_origport(msg) != peer_port) ||
- (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;
- tipc_port_unlock(p_ptr);
- if (!cb || connected)
- 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_MCAST_MSG:
- case TIPC_NAMED_MSG:{
- tipc_named_msg_err_event cb =
- up_ptr->named_err_cb;
- tipc_port_unlock(p_ptr);
- if (!cb || connected)
- break;
- dseq.type = msg_nametype(msg);
- dseq.lower = msg_nameinst(msg);
- dseq.upper = (message_type == TIPC_NAMED_MSG)
- ? dseq.lower : msg_nameupper(msg);
- 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 0;
- }
- /*
- * 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;
- up_ptr = kmalloc(sizeof(*up_ptr), GFP_ATOMIC);
- if (!up_ptr) {
- warn("Port creation failed, no memory\n");
- return -ENOMEM;
- }
- p_ptr = (struct port *)tipc_createport_raw(NULL, port_dispatcher,
- port_wakeup, importance);
- 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;
- tipc_port_unlock(p_ptr);
- return 0;
- }
- int tipc_ownidentity(u32 ref, struct tipc_portid *id)
- {
- id->ref = ref;
- id->node = tipc_own_addr;
- return 0;
- }
- 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);
- tipc_port_unlock(p_ptr);
- return 0;
- }
- 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);
- tipc_port_unlock(p_ptr);
- return 0;
- }
- 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);
- if (!p_ptr)
- return -EINVAL;
- 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->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 = 0;
- }
- 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 (!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 = 0;
- } 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 = 0;
- break;
- }
- }
- if (list_empty(&p_ptr->publications))
- p_ptr->publ.published = 0;
- 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 = 0;
- exit:
- tipc_port_unlock(p_ptr);
- p_ptr->publ.max_pkt = tipc_link_get_max_pkt(peer->node, ref);
- return res;
- }
- /**
- * tipc_disconnect_port - disconnect port from peer
- *
- * Port must be locked.
- */
- int tipc_disconnect_port(struct tipc_port *tp_ptr)
- {
- int res;
- if (tp_ptr->connected) {
- tp_ptr->connected = 0;
- /* let timer expire on it's own to avoid deadlock! */
- tipc_nodesub_unsubscribe(
- &((struct port *)tp_ptr)->subscription);
- res = 0;
- } else {
- res = -ENOTCONN;
- }
- 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;
- p_ptr = tipc_port_lock(ref);
- if (!p_ptr)
- return -EINVAL;
- res = tipc_disconnect_port((struct tipc_port *)p_ptr);
- 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 0;
- }
- 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 = 0;
- } 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);
- skb_copy_to_linear_data(buf, 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);
- skb_copy_to_linear_data(buf, 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);
- skb_copy_to_linear_data(buf, 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);
- }
|