Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1 | /* |
Jon Paul Maloy | 02c00c2 | 2014-06-09 11:08:18 -0500 | [diff] [blame] | 2 | * net/tipc/socket.c: TIPC socket API |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 3 | * |
Jon Paul Maloy | 8826cde | 2014-03-12 11:31:09 -0400 | [diff] [blame] | 4 | * Copyright (c) 2001-2007, 2012-2014, Ericsson AB |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 5 | * Copyright (c) 2004-2008, 2010-2013, Wind River Systems |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 6 | * All rights reserved. |
| 7 | * |
Per Liden | 9ea1fd3 | 2006-01-11 13:30:43 +0100 | [diff] [blame] | 8 | * Redistribution and use in source and binary forms, with or without |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 9 | * modification, are permitted provided that the following conditions are met: |
| 10 | * |
Per Liden | 9ea1fd3 | 2006-01-11 13:30:43 +0100 | [diff] [blame] | 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. |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 19 | * |
Per Liden | 9ea1fd3 | 2006-01-11 13:30:43 +0100 | [diff] [blame] | 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 |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 34 | * POSSIBILITY OF SUCH DAMAGE. |
| 35 | */ |
| 36 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 37 | #include "core.h" |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 38 | #include "name_table.h" |
Erik Hugne | 78acb1f | 2014-04-24 16:26:47 +0200 | [diff] [blame] | 39 | #include "node.h" |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 40 | #include "link.h" |
Erik Hugne | 2cf8aa1 | 2012-06-29 00:16:37 -0400 | [diff] [blame] | 41 | #include <linux/export.h> |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 42 | #include "config.h" |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 43 | #include "socket.h" |
Erik Hugne | 2cf8aa1 | 2012-06-29 00:16:37 -0400 | [diff] [blame] | 44 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 45 | #define SS_LISTENING -1 /* socket is listening */ |
| 46 | #define SS_READY -2 /* socket is connectionless */ |
| 47 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 48 | #define CONN_TIMEOUT_DEFAULT 8000 /* default connect timeout = 8s */ |
Jon Paul Maloy | dadebc0 | 2014-08-22 18:09:11 -0400 | [diff] [blame] | 49 | #define CONN_PROBING_INTERVAL 3600000 /* [ms] => 1 h */ |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 50 | #define TIPC_FWD_MSG 1 |
| 51 | #define TIPC_CONN_OK 0 |
| 52 | #define TIPC_CONN_PROBING 1 |
| 53 | |
| 54 | /** |
| 55 | * struct tipc_sock - TIPC socket structure |
| 56 | * @sk: socket - interacts with 'port' and with user via the socket API |
| 57 | * @connected: non-zero if port is currently connected to a peer port |
| 58 | * @conn_type: TIPC type used when connection was established |
| 59 | * @conn_instance: TIPC instance used when connection was established |
| 60 | * @published: non-zero if port has one or more associated names |
| 61 | * @max_pkt: maximum packet size "hint" used when building messages sent by port |
| 62 | * @ref: unique reference to port in TIPC object registry |
| 63 | * @phdr: preformatted message header used when sending messages |
| 64 | * @port_list: adjacent ports in TIPC's global list of ports |
| 65 | * @publications: list of publications for port |
| 66 | * @pub_count: total # of publications port has made during its lifetime |
| 67 | * @probing_state: |
| 68 | * @probing_interval: |
| 69 | * @timer: |
| 70 | * @port: port - interacts with 'sk' and with the rest of the TIPC stack |
| 71 | * @peer_name: the peer of the connection, if any |
| 72 | * @conn_timeout: the time we can wait for an unresponded setup request |
| 73 | * @dupl_rcvcnt: number of bytes counted twice, in both backlog and rcv queue |
| 74 | * @link_cong: non-zero if owner must sleep because of link congestion |
| 75 | * @sent_unacked: # messages sent by socket, and not yet acked by peer |
| 76 | * @rcv_unacked: # messages read by user, but not yet acked back to peer |
| 77 | */ |
| 78 | struct tipc_sock { |
| 79 | struct sock sk; |
| 80 | int connected; |
| 81 | u32 conn_type; |
| 82 | u32 conn_instance; |
| 83 | int published; |
| 84 | u32 max_pkt; |
| 85 | u32 ref; |
| 86 | struct tipc_msg phdr; |
| 87 | struct list_head sock_list; |
| 88 | struct list_head publications; |
| 89 | u32 pub_count; |
| 90 | u32 probing_state; |
| 91 | u32 probing_interval; |
| 92 | struct timer_list timer; |
| 93 | uint conn_timeout; |
| 94 | atomic_t dupl_rcvcnt; |
| 95 | bool link_cong; |
| 96 | uint sent_unacked; |
| 97 | uint rcv_unacked; |
| 98 | }; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 99 | |
Jon Paul Maloy | 4f4482d | 2014-05-14 05:39:09 -0400 | [diff] [blame] | 100 | static int tipc_backlog_rcv(struct sock *sk, struct sk_buff *skb); |
David S. Miller | 676d236 | 2014-04-11 16:15:36 -0400 | [diff] [blame] | 101 | static void tipc_data_ready(struct sock *sk); |
Ying Xue | f288bef | 2012-08-21 11:16:57 +0800 | [diff] [blame] | 102 | static void tipc_write_space(struct sock *sk); |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 103 | static int tipc_release(struct socket *sock); |
| 104 | static int tipc_accept(struct socket *sock, struct socket *new_sock, int flags); |
Jon Paul Maloy | 0abd8ff | 2014-07-16 20:41:01 -0400 | [diff] [blame] | 105 | static int tipc_wait_for_sndmsg(struct socket *sock, long *timeo_p); |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 106 | static void tipc_sk_timeout(unsigned long ref); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 107 | static int tipc_sk_publish(struct tipc_sock *tsk, uint scope, |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 108 | struct tipc_name_seq const *seq); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 109 | static int tipc_sk_withdraw(struct tipc_sock *tsk, uint scope, |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 110 | struct tipc_name_seq const *seq); |
Jon Paul Maloy | 808d90f | 2014-08-22 18:09:19 -0400 | [diff] [blame] | 111 | static u32 tipc_sk_ref_acquire(struct tipc_sock *tsk); |
| 112 | static void tipc_sk_ref_discard(u32 ref); |
| 113 | static struct tipc_sock *tipc_sk_get(u32 ref); |
| 114 | static struct tipc_sock *tipc_sk_get_next(u32 *ref); |
| 115 | static void tipc_sk_put(struct tipc_sock *tsk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 116 | |
Florian Westphal | bca65ea | 2008-02-07 18:18:01 -0800 | [diff] [blame] | 117 | static const struct proto_ops packet_ops; |
| 118 | static const struct proto_ops stream_ops; |
| 119 | static const struct proto_ops msg_ops; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 120 | |
| 121 | static struct proto tipc_proto; |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 122 | static struct proto tipc_proto_kern; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 123 | |
Richard Alpe | 1a1a143 | 2014-11-20 10:29:11 +0100 | [diff] [blame] | 124 | static const struct nla_policy tipc_nl_sock_policy[TIPC_NLA_SOCK_MAX + 1] = { |
| 125 | [TIPC_NLA_SOCK_UNSPEC] = { .type = NLA_UNSPEC }, |
| 126 | [TIPC_NLA_SOCK_ADDR] = { .type = NLA_U32 }, |
| 127 | [TIPC_NLA_SOCK_REF] = { .type = NLA_U32 }, |
| 128 | [TIPC_NLA_SOCK_CON] = { .type = NLA_NESTED }, |
| 129 | [TIPC_NLA_SOCK_HAS_PUBL] = { .type = NLA_FLAG } |
| 130 | }; |
| 131 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 132 | /* |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 133 | * Revised TIPC socket locking policy: |
| 134 | * |
| 135 | * Most socket operations take the standard socket lock when they start |
| 136 | * and hold it until they finish (or until they need to sleep). Acquiring |
| 137 | * this lock grants the owner exclusive access to the fields of the socket |
| 138 | * data structures, with the exception of the backlog queue. A few socket |
| 139 | * operations can be done without taking the socket lock because they only |
| 140 | * read socket information that never changes during the life of the socket. |
| 141 | * |
| 142 | * Socket operations may acquire the lock for the associated TIPC port if they |
| 143 | * need to perform an operation on the port. If any routine needs to acquire |
| 144 | * both the socket lock and the port lock it must take the socket lock first |
| 145 | * to avoid the risk of deadlock. |
| 146 | * |
| 147 | * The dispatcher handling incoming messages cannot grab the socket lock in |
| 148 | * the standard fashion, since invoked it runs at the BH level and cannot block. |
| 149 | * Instead, it checks to see if the socket lock is currently owned by someone, |
| 150 | * and either handles the message itself or adds it to the socket's backlog |
| 151 | * queue; in the latter case the queued message is processed once the process |
| 152 | * owning the socket lock releases it. |
| 153 | * |
| 154 | * NOTE: Releasing the socket lock while an operation is sleeping overcomes |
| 155 | * the problem of a blocked socket operation preventing any other operations |
| 156 | * from occurring. However, applications must be careful if they have |
| 157 | * multiple threads trying to send (or receive) on the same socket, as these |
| 158 | * operations might interfere with each other. For example, doing a connect |
| 159 | * and a receive at the same time might allow the receive to consume the |
| 160 | * ACK message meant for the connect. While additional work could be done |
| 161 | * to try and overcome this, it doesn't seem to be worthwhile at the present. |
| 162 | * |
| 163 | * NOTE: Releasing the socket lock while an operation is sleeping also ensures |
| 164 | * that another operation that must be performed in a non-blocking manner is |
| 165 | * not delayed for very long because the lock has already been taken. |
| 166 | * |
| 167 | * NOTE: This code assumes that certain fields of a port/socket pair are |
| 168 | * constant over its lifetime; such fields can be examined without taking |
| 169 | * the socket lock and/or port lock, and do not need to be re-read even |
| 170 | * after resuming processing after waiting. These fields include: |
| 171 | * - socket type |
| 172 | * - pointer to socket sk structure (aka tipc_sock structure) |
| 173 | * - pointer to port structure |
| 174 | * - port reference |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 175 | */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 176 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 177 | static u32 tsk_peer_node(struct tipc_sock *tsk) |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 178 | { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 179 | return msg_destnode(&tsk->phdr); |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 180 | } |
| 181 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 182 | static u32 tsk_peer_port(struct tipc_sock *tsk) |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 183 | { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 184 | return msg_destport(&tsk->phdr); |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 185 | } |
| 186 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 187 | static bool tsk_unreliable(struct tipc_sock *tsk) |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 188 | { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 189 | return msg_src_droppable(&tsk->phdr) != 0; |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 190 | } |
| 191 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 192 | static void tsk_set_unreliable(struct tipc_sock *tsk, bool unreliable) |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 193 | { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 194 | msg_set_src_droppable(&tsk->phdr, unreliable ? 1 : 0); |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 195 | } |
| 196 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 197 | static bool tsk_unreturnable(struct tipc_sock *tsk) |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 198 | { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 199 | return msg_dest_droppable(&tsk->phdr) != 0; |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 200 | } |
| 201 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 202 | static void tsk_set_unreturnable(struct tipc_sock *tsk, bool unreturnable) |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 203 | { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 204 | msg_set_dest_droppable(&tsk->phdr, unreturnable ? 1 : 0); |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 205 | } |
| 206 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 207 | static int tsk_importance(struct tipc_sock *tsk) |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 208 | { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 209 | return msg_importance(&tsk->phdr); |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 210 | } |
| 211 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 212 | static int tsk_set_importance(struct tipc_sock *tsk, int imp) |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 213 | { |
| 214 | if (imp > TIPC_CRITICAL_IMPORTANCE) |
| 215 | return -EINVAL; |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 216 | msg_set_importance(&tsk->phdr, (u32)imp); |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 217 | return 0; |
| 218 | } |
Jon Paul Maloy | 8826cde | 2014-03-12 11:31:09 -0400 | [diff] [blame] | 219 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 220 | static struct tipc_sock *tipc_sk(const struct sock *sk) |
| 221 | { |
| 222 | return container_of(sk, struct tipc_sock, sk); |
| 223 | } |
| 224 | |
| 225 | static int tsk_conn_cong(struct tipc_sock *tsk) |
| 226 | { |
| 227 | return tsk->sent_unacked >= TIPC_FLOWCTRL_WIN; |
| 228 | } |
| 229 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 230 | /** |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 231 | * tsk_advance_rx_queue - discard first buffer in socket receive queue |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 232 | * |
| 233 | * Caller must hold socket lock |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 234 | */ |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 235 | static void tsk_advance_rx_queue(struct sock *sk) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 236 | { |
Allan Stephens | 5f6d912 | 2011-11-04 13:24:29 -0400 | [diff] [blame] | 237 | kfree_skb(__skb_dequeue(&sk->sk_receive_queue)); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 238 | } |
| 239 | |
| 240 | /** |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 241 | * tsk_rej_rx_queue - reject all buffers in socket receive queue |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 242 | * |
| 243 | * Caller must hold socket lock |
| 244 | */ |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 245 | static void tsk_rej_rx_queue(struct sock *sk) |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 246 | { |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 247 | struct sk_buff *skb; |
Jon Paul Maloy | 8db1bae | 2014-06-25 20:41:35 -0500 | [diff] [blame] | 248 | u32 dnode; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 249 | |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 250 | while ((skb = __skb_dequeue(&sk->sk_receive_queue))) { |
| 251 | if (tipc_msg_reverse(skb, &dnode, TIPC_ERR_NO_PORT)) |
| 252 | tipc_link_xmit_skb(skb, dnode, 0); |
Jon Paul Maloy | 8db1bae | 2014-06-25 20:41:35 -0500 | [diff] [blame] | 253 | } |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 254 | } |
| 255 | |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 256 | /* tsk_peer_msg - verify if message was sent by connected port's peer |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 257 | * |
| 258 | * Handles cases where the node's network address has changed from |
| 259 | * the default of <0.0.0> to its configured setting. |
| 260 | */ |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 261 | static bool tsk_peer_msg(struct tipc_sock *tsk, struct tipc_msg *msg) |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 262 | { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 263 | u32 peer_port = tsk_peer_port(tsk); |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 264 | u32 orig_node; |
| 265 | u32 peer_node; |
| 266 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 267 | if (unlikely(!tsk->connected)) |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 268 | return false; |
| 269 | |
| 270 | if (unlikely(msg_origport(msg) != peer_port)) |
| 271 | return false; |
| 272 | |
| 273 | orig_node = msg_orignode(msg); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 274 | peer_node = tsk_peer_node(tsk); |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 275 | |
| 276 | if (likely(orig_node == peer_node)) |
| 277 | return true; |
| 278 | |
| 279 | if (!orig_node && (peer_node == tipc_own_addr)) |
| 280 | return true; |
| 281 | |
| 282 | if (!peer_node && (orig_node == tipc_own_addr)) |
| 283 | return true; |
| 284 | |
| 285 | return false; |
| 286 | } |
| 287 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 288 | /** |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 289 | * tipc_sk_create - create a TIPC socket |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 290 | * @net: network namespace (must be default network) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 291 | * @sock: pre-allocated socket structure |
| 292 | * @protocol: protocol indicator (must be 0) |
Eric Paris | 3f378b68 | 2009-11-05 22:18:14 -0800 | [diff] [blame] | 293 | * @kern: caused by kernel or by userspace? |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 294 | * |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 295 | * This routine creates additional data structures used by the TIPC socket, |
| 296 | * initializes them, and links them together. |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 297 | * |
| 298 | * Returns 0 on success, errno otherwise |
| 299 | */ |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 300 | static int tipc_sk_create(struct net *net, struct socket *sock, |
| 301 | int protocol, int kern) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 302 | { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 303 | const struct proto_ops *ops; |
| 304 | socket_state state; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 305 | struct sock *sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 306 | struct tipc_sock *tsk; |
Jon Paul Maloy | 5b8fa7c | 2014-08-22 18:09:13 -0400 | [diff] [blame] | 307 | struct tipc_msg *msg; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 308 | u32 ref; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 309 | |
| 310 | /* Validate arguments */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 311 | if (unlikely(protocol != 0)) |
| 312 | return -EPROTONOSUPPORT; |
| 313 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 314 | switch (sock->type) { |
| 315 | case SOCK_STREAM: |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 316 | ops = &stream_ops; |
| 317 | state = SS_UNCONNECTED; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 318 | break; |
| 319 | case SOCK_SEQPACKET: |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 320 | ops = &packet_ops; |
| 321 | state = SS_UNCONNECTED; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 322 | break; |
| 323 | case SOCK_DGRAM: |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 324 | case SOCK_RDM: |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 325 | ops = &msg_ops; |
| 326 | state = SS_READY; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 327 | break; |
Allan Stephens | 4997865 | 2006-06-25 23:47:18 -0700 | [diff] [blame] | 328 | default: |
Allan Stephens | 4997865 | 2006-06-25 23:47:18 -0700 | [diff] [blame] | 329 | return -EPROTOTYPE; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 330 | } |
| 331 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 332 | /* Allocate socket's protocol area */ |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 333 | if (!kern) |
| 334 | sk = sk_alloc(net, AF_TIPC, GFP_KERNEL, &tipc_proto); |
| 335 | else |
| 336 | sk = sk_alloc(net, AF_TIPC, GFP_KERNEL, &tipc_proto_kern); |
| 337 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 338 | if (sk == NULL) |
| 339 | return -ENOMEM; |
| 340 | |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 341 | tsk = tipc_sk(sk); |
Jon Paul Maloy | 808d90f | 2014-08-22 18:09:19 -0400 | [diff] [blame] | 342 | ref = tipc_sk_ref_acquire(tsk); |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 343 | if (!ref) { |
Jon Paul Maloy | 5b8fa7c | 2014-08-22 18:09:13 -0400 | [diff] [blame] | 344 | pr_warn("Socket create failed; reference table exhausted\n"); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 345 | return -ENOMEM; |
| 346 | } |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 347 | tsk->max_pkt = MAX_PKT_DEFAULT; |
| 348 | tsk->ref = ref; |
| 349 | INIT_LIST_HEAD(&tsk->publications); |
| 350 | msg = &tsk->phdr; |
Jon Paul Maloy | 5b8fa7c | 2014-08-22 18:09:13 -0400 | [diff] [blame] | 351 | tipc_msg_init(msg, TIPC_LOW_IMPORTANCE, TIPC_NAMED_MSG, |
| 352 | NAMED_H_SIZE, 0); |
| 353 | msg_set_origport(msg, ref); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 354 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 355 | /* Finish initializing socket data structures */ |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 356 | sock->ops = ops; |
| 357 | sock->state = state; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 358 | sock_init_data(sock, sk); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 359 | k_init_timer(&tsk->timer, (Handler)tipc_sk_timeout, ref); |
Jon Paul Maloy | 4f4482d | 2014-05-14 05:39:09 -0400 | [diff] [blame] | 360 | sk->sk_backlog_rcv = tipc_backlog_rcv; |
Ying Xue | cc79dd1 | 2013-06-17 10:54:37 -0400 | [diff] [blame] | 361 | sk->sk_rcvbuf = sysctl_tipc_rmem[1]; |
Ying Xue | f288bef | 2012-08-21 11:16:57 +0800 | [diff] [blame] | 362 | sk->sk_data_ready = tipc_data_ready; |
| 363 | sk->sk_write_space = tipc_write_space; |
Jon Paul Maloy | 4f4482d | 2014-05-14 05:39:09 -0400 | [diff] [blame] | 364 | tsk->conn_timeout = CONN_TIMEOUT_DEFAULT; |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 365 | tsk->sent_unacked = 0; |
Jon Paul Maloy | 4f4482d | 2014-05-14 05:39:09 -0400 | [diff] [blame] | 366 | atomic_set(&tsk->dupl_rcvcnt, 0); |
Allan Stephens | 7ef43eb | 2008-05-12 15:42:28 -0700 | [diff] [blame] | 367 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 368 | if (sock->state == SS_READY) { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 369 | tsk_set_unreturnable(tsk, true); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 370 | if (sock->type == SOCK_DGRAM) |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 371 | tsk_set_unreliable(tsk, true); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 372 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 373 | return 0; |
| 374 | } |
| 375 | |
| 376 | /** |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 377 | * tipc_sock_create_local - create TIPC socket from inside TIPC module |
| 378 | * @type: socket type - SOCK_RDM or SOCK_SEQPACKET |
| 379 | * |
| 380 | * We cannot use sock_creat_kern here because it bumps module user count. |
| 381 | * Since socket owner and creator is the same module we must make sure |
| 382 | * that module count remains zero for module local sockets, otherwise |
| 383 | * we cannot do rmmod. |
| 384 | * |
| 385 | * Returns 0 on success, errno otherwise |
| 386 | */ |
| 387 | int tipc_sock_create_local(int type, struct socket **res) |
| 388 | { |
| 389 | int rc; |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 390 | |
| 391 | rc = sock_create_lite(AF_TIPC, type, 0, res); |
| 392 | if (rc < 0) { |
| 393 | pr_err("Failed to create kernel socket\n"); |
| 394 | return rc; |
| 395 | } |
| 396 | tipc_sk_create(&init_net, *res, 0, 1); |
| 397 | |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 398 | return 0; |
| 399 | } |
| 400 | |
| 401 | /** |
| 402 | * tipc_sock_release_local - release socket created by tipc_sock_create_local |
| 403 | * @sock: the socket to be released. |
| 404 | * |
| 405 | * Module reference count is not incremented when such sockets are created, |
| 406 | * so we must keep it from being decremented when they are released. |
| 407 | */ |
| 408 | void tipc_sock_release_local(struct socket *sock) |
| 409 | { |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 410 | tipc_release(sock); |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 411 | sock->ops = NULL; |
| 412 | sock_release(sock); |
| 413 | } |
| 414 | |
| 415 | /** |
| 416 | * tipc_sock_accept_local - accept a connection on a socket created |
| 417 | * with tipc_sock_create_local. Use this function to avoid that |
| 418 | * module reference count is inadvertently incremented. |
| 419 | * |
| 420 | * @sock: the accepting socket |
| 421 | * @newsock: reference to the new socket to be created |
| 422 | * @flags: socket flags |
| 423 | */ |
| 424 | |
| 425 | int tipc_sock_accept_local(struct socket *sock, struct socket **newsock, |
Paul Gortmaker | ae8509c | 2013-06-17 10:54:47 -0400 | [diff] [blame] | 426 | int flags) |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 427 | { |
| 428 | struct sock *sk = sock->sk; |
| 429 | int ret; |
| 430 | |
| 431 | ret = sock_create_lite(sk->sk_family, sk->sk_type, |
| 432 | sk->sk_protocol, newsock); |
| 433 | if (ret < 0) |
| 434 | return ret; |
| 435 | |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 436 | ret = tipc_accept(sock, *newsock, flags); |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 437 | if (ret < 0) { |
| 438 | sock_release(*newsock); |
| 439 | return ret; |
| 440 | } |
| 441 | (*newsock)->ops = sock->ops; |
| 442 | return ret; |
| 443 | } |
| 444 | |
| 445 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 446 | * tipc_release - destroy a TIPC socket |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 447 | * @sock: socket to destroy |
| 448 | * |
| 449 | * This routine cleans up any messages that are still queued on the socket. |
| 450 | * For DGRAM and RDM socket types, all queued messages are rejected. |
| 451 | * For SEQPACKET and STREAM socket types, the first message is rejected |
| 452 | * and any others are discarded. (If the first message on a STREAM socket |
| 453 | * is partially-read, it is discarded and the next one is rejected instead.) |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 454 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 455 | * NOTE: Rejected messages are not necessarily returned to the sender! They |
| 456 | * are returned or discarded according to the "destination droppable" setting |
| 457 | * specified for the message by the sender. |
| 458 | * |
| 459 | * Returns 0 on success, errno otherwise |
| 460 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 461 | static int tipc_release(struct socket *sock) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 462 | { |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 463 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 464 | struct tipc_sock *tsk; |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 465 | struct sk_buff *skb; |
Jon Paul Maloy | 8db1bae | 2014-06-25 20:41:35 -0500 | [diff] [blame] | 466 | u32 dnode; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 467 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 468 | /* |
| 469 | * Exit if socket isn't fully initialized (occurs when a failed accept() |
| 470 | * releases a pre-allocated child socket that was never used) |
| 471 | */ |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 472 | if (sk == NULL) |
| 473 | return 0; |
| 474 | |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 475 | tsk = tipc_sk(sk); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 476 | lock_sock(sk); |
| 477 | |
| 478 | /* |
| 479 | * Reject all unreceived messages, except on an active connection |
| 480 | * (which disconnects locally & sends a 'FIN+' to peer) |
| 481 | */ |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 482 | dnode = tsk_peer_node(tsk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 483 | while (sock->state != SS_DISCONNECTING) { |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 484 | skb = __skb_dequeue(&sk->sk_receive_queue); |
| 485 | if (skb == NULL) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 486 | break; |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 487 | if (TIPC_SKB_CB(skb)->handle != NULL) |
| 488 | kfree_skb(skb); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 489 | else { |
| 490 | if ((sock->state == SS_CONNECTING) || |
| 491 | (sock->state == SS_CONNECTED)) { |
| 492 | sock->state = SS_DISCONNECTING; |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 493 | tsk->connected = 0; |
| 494 | tipc_node_remove_conn(dnode, tsk->ref); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 495 | } |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 496 | if (tipc_msg_reverse(skb, &dnode, TIPC_ERR_NO_PORT)) |
| 497 | tipc_link_xmit_skb(skb, dnode, 0); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 498 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 499 | } |
| 500 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 501 | tipc_sk_withdraw(tsk, 0, NULL); |
| 502 | tipc_sk_ref_discard(tsk->ref); |
| 503 | k_cancel_timer(&tsk->timer); |
| 504 | if (tsk->connected) { |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 505 | skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE, TIPC_CONN_MSG, |
Jon Paul Maloy | 5b8fa7c | 2014-08-22 18:09:13 -0400 | [diff] [blame] | 506 | SHORT_H_SIZE, 0, dnode, tipc_own_addr, |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 507 | tsk_peer_port(tsk), |
| 508 | tsk->ref, TIPC_ERR_NO_PORT); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 509 | if (skb) |
| 510 | tipc_link_xmit_skb(skb, dnode, tsk->ref); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 511 | tipc_node_remove_conn(dnode, tsk->ref); |
Jon Paul Maloy | 5b8fa7c | 2014-08-22 18:09:13 -0400 | [diff] [blame] | 512 | } |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 513 | k_term_timer(&tsk->timer); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 514 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 515 | /* Discard any remaining (connection-based) messages in receive queue */ |
Ying Xue | 57467e5 | 2013-01-20 23:30:08 +0100 | [diff] [blame] | 516 | __skb_queue_purge(&sk->sk_receive_queue); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 517 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 518 | /* Reject any messages that accumulated in backlog queue */ |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 519 | sock->state = SS_DISCONNECTING; |
| 520 | release_sock(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 521 | sock_put(sk); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 522 | sock->sk = NULL; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 523 | |
Geert Uytterhoeven | 065d7e3 | 2014-04-06 15:56:14 +0200 | [diff] [blame] | 524 | return 0; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 525 | } |
| 526 | |
| 527 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 528 | * tipc_bind - associate or disassocate TIPC name(s) with a socket |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 529 | * @sock: socket structure |
| 530 | * @uaddr: socket address describing name(s) and desired operation |
| 531 | * @uaddr_len: size of socket address data structure |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 532 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 533 | * Name and name sequence binding is indicated using a positive scope value; |
| 534 | * a negative scope value unbinds the specified name. Specifying no name |
| 535 | * (i.e. a socket address length of 0) unbinds all names from the socket. |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 536 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 537 | * Returns 0 on success, errno otherwise |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 538 | * |
| 539 | * NOTE: This routine doesn't need to take the socket lock since it doesn't |
| 540 | * access any non-constant socket information. |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 541 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 542 | static int tipc_bind(struct socket *sock, struct sockaddr *uaddr, |
| 543 | int uaddr_len) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 544 | { |
Ying Xue | 8460276 | 2013-12-27 10:18:28 +0800 | [diff] [blame] | 545 | struct sock *sk = sock->sk; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 546 | struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 547 | struct tipc_sock *tsk = tipc_sk(sk); |
Ying Xue | 8460276 | 2013-12-27 10:18:28 +0800 | [diff] [blame] | 548 | int res = -EINVAL; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 549 | |
Ying Xue | 8460276 | 2013-12-27 10:18:28 +0800 | [diff] [blame] | 550 | lock_sock(sk); |
| 551 | if (unlikely(!uaddr_len)) { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 552 | res = tipc_sk_withdraw(tsk, 0, NULL); |
Ying Xue | 8460276 | 2013-12-27 10:18:28 +0800 | [diff] [blame] | 553 | goto exit; |
| 554 | } |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 555 | |
Ying Xue | 8460276 | 2013-12-27 10:18:28 +0800 | [diff] [blame] | 556 | if (uaddr_len < sizeof(struct sockaddr_tipc)) { |
| 557 | res = -EINVAL; |
| 558 | goto exit; |
| 559 | } |
| 560 | if (addr->family != AF_TIPC) { |
| 561 | res = -EAFNOSUPPORT; |
| 562 | goto exit; |
| 563 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 564 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 565 | if (addr->addrtype == TIPC_ADDR_NAME) |
| 566 | addr->addr.nameseq.upper = addr->addr.nameseq.lower; |
Ying Xue | 8460276 | 2013-12-27 10:18:28 +0800 | [diff] [blame] | 567 | else if (addr->addrtype != TIPC_ADDR_NAMESEQ) { |
| 568 | res = -EAFNOSUPPORT; |
| 569 | goto exit; |
| 570 | } |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 571 | |
Ying Xue | 13a2e89 | 2013-06-17 10:54:40 -0400 | [diff] [blame] | 572 | if ((addr->addr.nameseq.type < TIPC_RESERVED_TYPES) && |
Ying Xue | 7d0ab17 | 2013-06-17 10:54:41 -0400 | [diff] [blame] | 573 | (addr->addr.nameseq.type != TIPC_TOP_SRV) && |
Ying Xue | 8460276 | 2013-12-27 10:18:28 +0800 | [diff] [blame] | 574 | (addr->addr.nameseq.type != TIPC_CFG_SRV)) { |
| 575 | res = -EACCES; |
| 576 | goto exit; |
| 577 | } |
Allan Stephens | c422f1b | 2011-11-02 15:49:40 -0400 | [diff] [blame] | 578 | |
Ying Xue | 8460276 | 2013-12-27 10:18:28 +0800 | [diff] [blame] | 579 | res = (addr->scope > 0) ? |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 580 | tipc_sk_publish(tsk, addr->scope, &addr->addr.nameseq) : |
| 581 | tipc_sk_withdraw(tsk, -addr->scope, &addr->addr.nameseq); |
Ying Xue | 8460276 | 2013-12-27 10:18:28 +0800 | [diff] [blame] | 582 | exit: |
| 583 | release_sock(sk); |
| 584 | return res; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 585 | } |
| 586 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 587 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 588 | * tipc_getname - get port ID of socket or peer socket |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 589 | * @sock: socket structure |
| 590 | * @uaddr: area for returned socket address |
| 591 | * @uaddr_len: area for returned length of socket address |
Allan Stephens | 2da5991 | 2008-07-14 22:43:32 -0700 | [diff] [blame] | 592 | * @peer: 0 = own ID, 1 = current peer ID, 2 = current/former peer ID |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 593 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 594 | * Returns 0 on success, errno otherwise |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 595 | * |
Allan Stephens | 2da5991 | 2008-07-14 22:43:32 -0700 | [diff] [blame] | 596 | * NOTE: This routine doesn't need to take the socket lock since it only |
| 597 | * accesses socket information that is unchanging (or which changes in |
Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 598 | * a completely predictable manner). |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 599 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 600 | static int tipc_getname(struct socket *sock, struct sockaddr *uaddr, |
| 601 | int *uaddr_len, int peer) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 602 | { |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 603 | struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 604 | struct tipc_sock *tsk = tipc_sk(sock->sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 605 | |
Kulikov Vasiliy | 88f8a5e | 2010-10-31 07:10:32 +0000 | [diff] [blame] | 606 | memset(addr, 0, sizeof(*addr)); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 607 | if (peer) { |
Allan Stephens | 2da5991 | 2008-07-14 22:43:32 -0700 | [diff] [blame] | 608 | if ((sock->state != SS_CONNECTED) && |
| 609 | ((peer != 2) || (sock->state != SS_DISCONNECTING))) |
| 610 | return -ENOTCONN; |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 611 | addr->addr.id.ref = tsk_peer_port(tsk); |
| 612 | addr->addr.id.node = tsk_peer_node(tsk); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 613 | } else { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 614 | addr->addr.id.ref = tsk->ref; |
Allan Stephens | b924dcf | 2010-11-30 12:01:03 +0000 | [diff] [blame] | 615 | addr->addr.id.node = tipc_own_addr; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 616 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 617 | |
| 618 | *uaddr_len = sizeof(*addr); |
| 619 | addr->addrtype = TIPC_ADDR_ID; |
| 620 | addr->family = AF_TIPC; |
| 621 | addr->scope = 0; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 622 | addr->addr.name.domain = 0; |
| 623 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 624 | return 0; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 625 | } |
| 626 | |
| 627 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 628 | * tipc_poll - read and possibly block on pollmask |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 629 | * @file: file structure associated with the socket |
| 630 | * @sock: socket for which to calculate the poll bits |
| 631 | * @wait: ??? |
| 632 | * |
Allan Stephens | 9b674e8 | 2008-03-26 16:48:21 -0700 | [diff] [blame] | 633 | * Returns pollmask value |
| 634 | * |
| 635 | * COMMENTARY: |
| 636 | * It appears that the usual socket locking mechanisms are not useful here |
| 637 | * since the pollmask info is potentially out-of-date the moment this routine |
| 638 | * exits. TCP and other protocols seem to rely on higher level poll routines |
| 639 | * to handle any preventable race conditions, so TIPC will do the same ... |
| 640 | * |
| 641 | * TIPC sets the returned events as follows: |
Allan Stephens | 9b674e8 | 2008-03-26 16:48:21 -0700 | [diff] [blame] | 642 | * |
Allan Stephens | f662c07 | 2010-08-17 11:00:06 +0000 | [diff] [blame] | 643 | * socket state flags set |
| 644 | * ------------ --------- |
| 645 | * unconnected no read flags |
Erik Hugne | c4fc298 | 2012-10-16 16:47:06 +0200 | [diff] [blame] | 646 | * POLLOUT if port is not congested |
Allan Stephens | f662c07 | 2010-08-17 11:00:06 +0000 | [diff] [blame] | 647 | * |
| 648 | * connecting POLLIN/POLLRDNORM if ACK/NACK in rx queue |
| 649 | * no write flags |
| 650 | * |
| 651 | * connected POLLIN/POLLRDNORM if data in rx queue |
| 652 | * POLLOUT if port is not congested |
| 653 | * |
| 654 | * disconnecting POLLIN/POLLRDNORM/POLLHUP |
| 655 | * no write flags |
| 656 | * |
| 657 | * listening POLLIN if SYN in rx queue |
| 658 | * no write flags |
| 659 | * |
| 660 | * ready POLLIN/POLLRDNORM if data in rx queue |
| 661 | * [connectionless] POLLOUT (since port cannot be congested) |
| 662 | * |
| 663 | * IMPORTANT: The fact that a read or write operation is indicated does NOT |
| 664 | * imply that the operation will succeed, merely that it should be performed |
| 665 | * and will not block. |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 666 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 667 | static unsigned int tipc_poll(struct file *file, struct socket *sock, |
| 668 | poll_table *wait) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 669 | { |
Allan Stephens | 9b674e8 | 2008-03-26 16:48:21 -0700 | [diff] [blame] | 670 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 671 | struct tipc_sock *tsk = tipc_sk(sk); |
Allan Stephens | f662c07 | 2010-08-17 11:00:06 +0000 | [diff] [blame] | 672 | u32 mask = 0; |
Allan Stephens | 9b674e8 | 2008-03-26 16:48:21 -0700 | [diff] [blame] | 673 | |
Ying Xue | f288bef | 2012-08-21 11:16:57 +0800 | [diff] [blame] | 674 | sock_poll_wait(file, sk_sleep(sk), wait); |
Allan Stephens | 9b674e8 | 2008-03-26 16:48:21 -0700 | [diff] [blame] | 675 | |
Allan Stephens | f662c07 | 2010-08-17 11:00:06 +0000 | [diff] [blame] | 676 | switch ((int)sock->state) { |
Erik Hugne | c4fc298 | 2012-10-16 16:47:06 +0200 | [diff] [blame] | 677 | case SS_UNCONNECTED: |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 678 | if (!tsk->link_cong) |
Erik Hugne | c4fc298 | 2012-10-16 16:47:06 +0200 | [diff] [blame] | 679 | mask |= POLLOUT; |
| 680 | break; |
Allan Stephens | f662c07 | 2010-08-17 11:00:06 +0000 | [diff] [blame] | 681 | case SS_READY: |
| 682 | case SS_CONNECTED: |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 683 | if (!tsk->link_cong && !tsk_conn_cong(tsk)) |
Allan Stephens | f662c07 | 2010-08-17 11:00:06 +0000 | [diff] [blame] | 684 | mask |= POLLOUT; |
| 685 | /* fall thru' */ |
| 686 | case SS_CONNECTING: |
| 687 | case SS_LISTENING: |
| 688 | if (!skb_queue_empty(&sk->sk_receive_queue)) |
| 689 | mask |= (POLLIN | POLLRDNORM); |
| 690 | break; |
| 691 | case SS_DISCONNECTING: |
| 692 | mask = (POLLIN | POLLRDNORM | POLLHUP); |
| 693 | break; |
| 694 | } |
Allan Stephens | 9b674e8 | 2008-03-26 16:48:21 -0700 | [diff] [blame] | 695 | |
| 696 | return mask; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 697 | } |
| 698 | |
Jon Paul Maloy | 0abd8ff | 2014-07-16 20:41:01 -0400 | [diff] [blame] | 699 | /** |
| 700 | * tipc_sendmcast - send multicast message |
| 701 | * @sock: socket structure |
| 702 | * @seq: destination address |
Al Viro | 562640f | 2014-11-15 01:13:43 -0500 | [diff] [blame] | 703 | * @msg: message to send |
Jon Paul Maloy | 0abd8ff | 2014-07-16 20:41:01 -0400 | [diff] [blame] | 704 | * @dsz: total length of message data |
| 705 | * @timeo: timeout to wait for wakeup |
| 706 | * |
| 707 | * Called from function tipc_sendmsg(), which has done all sanity checks |
| 708 | * Returns the number of bytes sent on success, or errno |
| 709 | */ |
| 710 | static int tipc_sendmcast(struct socket *sock, struct tipc_name_seq *seq, |
Al Viro | 562640f | 2014-11-15 01:13:43 -0500 | [diff] [blame] | 711 | struct msghdr *msg, size_t dsz, long timeo) |
Jon Paul Maloy | 0abd8ff | 2014-07-16 20:41:01 -0400 | [diff] [blame] | 712 | { |
| 713 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 714 | struct tipc_msg *mhdr = &tipc_sk(sk)->phdr; |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 715 | struct sk_buff_head head; |
Jon Paul Maloy | 0abd8ff | 2014-07-16 20:41:01 -0400 | [diff] [blame] | 716 | uint mtu; |
| 717 | int rc; |
| 718 | |
| 719 | msg_set_type(mhdr, TIPC_MCAST_MSG); |
| 720 | msg_set_lookup_scope(mhdr, TIPC_CLUSTER_SCOPE); |
| 721 | msg_set_destport(mhdr, 0); |
| 722 | msg_set_destnode(mhdr, 0); |
| 723 | msg_set_nametype(mhdr, seq->type); |
| 724 | msg_set_namelower(mhdr, seq->lower); |
| 725 | msg_set_nameupper(mhdr, seq->upper); |
| 726 | msg_set_hdr_sz(mhdr, MCAST_H_SIZE); |
| 727 | |
| 728 | new_mtu: |
| 729 | mtu = tipc_bclink_get_mtu(); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 730 | __skb_queue_head_init(&head); |
| 731 | rc = tipc_msg_build(mhdr, msg, 0, dsz, mtu, &head); |
Jon Paul Maloy | 0abd8ff | 2014-07-16 20:41:01 -0400 | [diff] [blame] | 732 | if (unlikely(rc < 0)) |
| 733 | return rc; |
| 734 | |
| 735 | do { |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 736 | rc = tipc_bclink_xmit(&head); |
Jon Paul Maloy | 0abd8ff | 2014-07-16 20:41:01 -0400 | [diff] [blame] | 737 | if (likely(rc >= 0)) { |
| 738 | rc = dsz; |
| 739 | break; |
| 740 | } |
| 741 | if (rc == -EMSGSIZE) |
| 742 | goto new_mtu; |
| 743 | if (rc != -ELINKCONG) |
| 744 | break; |
Jon Paul Maloy | 50100a5 | 2014-08-22 18:09:07 -0400 | [diff] [blame] | 745 | tipc_sk(sk)->link_cong = 1; |
Jon Paul Maloy | 0abd8ff | 2014-07-16 20:41:01 -0400 | [diff] [blame] | 746 | rc = tipc_wait_for_sndmsg(sock, &timeo); |
| 747 | if (rc) |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 748 | __skb_queue_purge(&head); |
Jon Paul Maloy | 0abd8ff | 2014-07-16 20:41:01 -0400 | [diff] [blame] | 749 | } while (!rc); |
| 750 | return rc; |
| 751 | } |
| 752 | |
Jon Paul Maloy | 078bec8 | 2014-07-16 20:41:00 -0400 | [diff] [blame] | 753 | /* tipc_sk_mcast_rcv - Deliver multicast message to all destination sockets |
| 754 | */ |
| 755 | void tipc_sk_mcast_rcv(struct sk_buff *buf) |
| 756 | { |
| 757 | struct tipc_msg *msg = buf_msg(buf); |
| 758 | struct tipc_port_list dports = {0, NULL, }; |
| 759 | struct tipc_port_list *item; |
| 760 | struct sk_buff *b; |
| 761 | uint i, last, dst = 0; |
| 762 | u32 scope = TIPC_CLUSTER_SCOPE; |
| 763 | |
| 764 | if (in_own_node(msg_orignode(msg))) |
| 765 | scope = TIPC_NODE_SCOPE; |
| 766 | |
| 767 | /* Create destination port list: */ |
| 768 | tipc_nametbl_mc_translate(msg_nametype(msg), |
| 769 | msg_namelower(msg), |
| 770 | msg_nameupper(msg), |
| 771 | scope, |
| 772 | &dports); |
| 773 | last = dports.count; |
| 774 | if (!last) { |
| 775 | kfree_skb(buf); |
| 776 | return; |
| 777 | } |
| 778 | |
| 779 | for (item = &dports; item; item = item->next) { |
| 780 | for (i = 0; i < PLSIZE && ++dst <= last; i++) { |
| 781 | b = (dst != last) ? skb_clone(buf, GFP_ATOMIC) : buf; |
| 782 | if (!b) { |
| 783 | pr_warn("Failed do clone mcast rcv buffer\n"); |
| 784 | continue; |
| 785 | } |
| 786 | msg_set_destport(msg, item->ports[i]); |
| 787 | tipc_sk_rcv(b); |
| 788 | } |
| 789 | } |
| 790 | tipc_port_list_free(&dports); |
| 791 | } |
| 792 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 793 | /** |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 794 | * tipc_sk_proto_rcv - receive a connection mng protocol message |
| 795 | * @tsk: receiving socket |
| 796 | * @dnode: node to send response message to, if any |
| 797 | * @buf: buffer containing protocol message |
| 798 | * Returns 0 (TIPC_OK) if message was consumed, 1 (TIPC_FWD_MSG) if |
| 799 | * (CONN_PROBE_REPLY) message should be forwarded. |
| 800 | */ |
Wei Yongjun | 52f50ce | 2014-07-20 13:14:28 +0800 | [diff] [blame] | 801 | static int tipc_sk_proto_rcv(struct tipc_sock *tsk, u32 *dnode, |
| 802 | struct sk_buff *buf) |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 803 | { |
| 804 | struct tipc_msg *msg = buf_msg(buf); |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 805 | int conn_cong; |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 806 | |
| 807 | /* Ignore if connection cannot be validated: */ |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 808 | if (!tsk_peer_msg(tsk, msg)) |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 809 | goto exit; |
| 810 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 811 | tsk->probing_state = TIPC_CONN_OK; |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 812 | |
| 813 | if (msg_type(msg) == CONN_ACK) { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 814 | conn_cong = tsk_conn_cong(tsk); |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 815 | tsk->sent_unacked -= msg_msgcnt(msg); |
| 816 | if (conn_cong) |
Jon Paul Maloy | 50100a5 | 2014-08-22 18:09:07 -0400 | [diff] [blame] | 817 | tsk->sk.sk_write_space(&tsk->sk); |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 818 | } else if (msg_type(msg) == CONN_PROBE) { |
| 819 | if (!tipc_msg_reverse(buf, dnode, TIPC_OK)) |
| 820 | return TIPC_OK; |
| 821 | msg_set_type(msg, CONN_PROBE_REPLY); |
| 822 | return TIPC_FWD_MSG; |
| 823 | } |
| 824 | /* Do nothing if msg_type() == CONN_PROBE_REPLY */ |
| 825 | exit: |
| 826 | kfree_skb(buf); |
| 827 | return TIPC_OK; |
| 828 | } |
| 829 | |
Ying Xue | 3f40504 | 2014-01-17 09:50:05 +0800 | [diff] [blame] | 830 | static int tipc_wait_for_sndmsg(struct socket *sock, long *timeo_p) |
| 831 | { |
| 832 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 833 | struct tipc_sock *tsk = tipc_sk(sk); |
Ying Xue | 3f40504 | 2014-01-17 09:50:05 +0800 | [diff] [blame] | 834 | DEFINE_WAIT(wait); |
| 835 | int done; |
| 836 | |
| 837 | do { |
| 838 | int err = sock_error(sk); |
| 839 | if (err) |
| 840 | return err; |
| 841 | if (sock->state == SS_DISCONNECTING) |
| 842 | return -EPIPE; |
| 843 | if (!*timeo_p) |
| 844 | return -EAGAIN; |
| 845 | if (signal_pending(current)) |
| 846 | return sock_intr_errno(*timeo_p); |
| 847 | |
| 848 | prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 849 | done = sk_wait_event(sk, timeo_p, !tsk->link_cong); |
Ying Xue | 3f40504 | 2014-01-17 09:50:05 +0800 | [diff] [blame] | 850 | finish_wait(sk_sleep(sk), &wait); |
| 851 | } while (!done); |
| 852 | return 0; |
| 853 | } |
| 854 | |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 855 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 856 | * tipc_sendmsg - send message in connectionless manner |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 857 | * @iocb: if NULL, indicates that socket lock is already held |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 858 | * @sock: socket structure |
| 859 | * @m: message to send |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 860 | * @dsz: amount of user data to be sent |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 861 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 862 | * Message must have an destination specified explicitly. |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 863 | * Used for SOCK_RDM and SOCK_DGRAM messages, |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 864 | * and for 'SYN' messages on SOCK_SEQPACKET and SOCK_STREAM connections. |
| 865 | * (Note: 'SYN+' is prohibited on SOCK_STREAM.) |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 866 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 867 | * Returns the number of bytes sent on success, or errno otherwise |
| 868 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 869 | static int tipc_sendmsg(struct kiocb *iocb, struct socket *sock, |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 870 | struct msghdr *m, size_t dsz) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 871 | { |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 872 | DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 873 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 874 | struct tipc_sock *tsk = tipc_sk(sk); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 875 | struct tipc_msg *mhdr = &tsk->phdr; |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 876 | u32 dnode, dport; |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 877 | struct sk_buff_head head; |
| 878 | struct sk_buff *skb; |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 879 | struct tipc_name_seq *seq = &dest->addr.nameseq; |
| 880 | u32 mtu; |
Ying Xue | 3f40504 | 2014-01-17 09:50:05 +0800 | [diff] [blame] | 881 | long timeo; |
Erik Hugne | 88b17b6 | 2014-12-03 14:44:44 +0100 | [diff] [blame] | 882 | int rc; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 883 | |
| 884 | if (unlikely(!dest)) |
| 885 | return -EDESTADDRREQ; |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 886 | |
Allan Stephens | 51f9cc1 | 2006-06-25 23:49:06 -0700 | [diff] [blame] | 887 | if (unlikely((m->msg_namelen < sizeof(*dest)) || |
| 888 | (dest->family != AF_TIPC))) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 889 | return -EINVAL; |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 890 | |
| 891 | if (dsz > TIPC_MAX_USER_MSG_SIZE) |
Allan Stephens | c29c3f7 | 2010-04-20 17:58:24 -0400 | [diff] [blame] | 892 | return -EMSGSIZE; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 893 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 894 | if (iocb) |
| 895 | lock_sock(sk); |
| 896 | |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 897 | if (unlikely(sock->state != SS_READY)) { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 898 | if (sock->state == SS_LISTENING) { |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 899 | rc = -EPIPE; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 900 | goto exit; |
Allan Stephens | 3388007b | 2006-06-25 23:44:57 -0700 | [diff] [blame] | 901 | } |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 902 | if (sock->state != SS_UNCONNECTED) { |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 903 | rc = -EISCONN; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 904 | goto exit; |
| 905 | } |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 906 | if (tsk->published) { |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 907 | rc = -EOPNOTSUPP; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 908 | goto exit; |
| 909 | } |
| 910 | if (dest->addrtype == TIPC_ADDR_NAME) { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 911 | tsk->conn_type = dest->addr.name.name.type; |
| 912 | tsk->conn_instance = dest->addr.name.name.instance; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 913 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 914 | } |
| 915 | |
Ying Xue | 3f40504 | 2014-01-17 09:50:05 +0800 | [diff] [blame] | 916 | timeo = sock_sndtimeo(sk, m->msg_flags & MSG_DONTWAIT); |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 917 | |
| 918 | if (dest->addrtype == TIPC_ADDR_MCAST) { |
Al Viro | 562640f | 2014-11-15 01:13:43 -0500 | [diff] [blame] | 919 | rc = tipc_sendmcast(sock, seq, m, dsz, timeo); |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 920 | goto exit; |
| 921 | } else if (dest->addrtype == TIPC_ADDR_NAME) { |
| 922 | u32 type = dest->addr.name.name.type; |
| 923 | u32 inst = dest->addr.name.name.instance; |
| 924 | u32 domain = dest->addr.name.domain; |
| 925 | |
| 926 | dnode = domain; |
| 927 | msg_set_type(mhdr, TIPC_NAMED_MSG); |
| 928 | msg_set_hdr_sz(mhdr, NAMED_H_SIZE); |
| 929 | msg_set_nametype(mhdr, type); |
| 930 | msg_set_nameinst(mhdr, inst); |
| 931 | msg_set_lookup_scope(mhdr, tipc_addr_scope(domain)); |
| 932 | dport = tipc_nametbl_translate(type, inst, &dnode); |
| 933 | msg_set_destnode(mhdr, dnode); |
| 934 | msg_set_destport(mhdr, dport); |
| 935 | if (unlikely(!dport && !dnode)) { |
| 936 | rc = -EHOSTUNREACH; |
| 937 | goto exit; |
| 938 | } |
| 939 | } else if (dest->addrtype == TIPC_ADDR_ID) { |
| 940 | dnode = dest->addr.id.node; |
| 941 | msg_set_type(mhdr, TIPC_DIRECT_MSG); |
| 942 | msg_set_lookup_scope(mhdr, 0); |
| 943 | msg_set_destnode(mhdr, dnode); |
| 944 | msg_set_destport(mhdr, dest->addr.id.ref); |
| 945 | msg_set_hdr_sz(mhdr, BASIC_H_SIZE); |
| 946 | } |
| 947 | |
| 948 | new_mtu: |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 949 | mtu = tipc_node_get_mtu(dnode, tsk->ref); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 950 | __skb_queue_head_init(&head); |
| 951 | rc = tipc_msg_build(mhdr, m, 0, dsz, mtu, &head); |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 952 | if (rc < 0) |
| 953 | goto exit; |
| 954 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 955 | do { |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 956 | skb = skb_peek(&head); |
| 957 | TIPC_SKB_CB(skb)->wakeup_pending = tsk->link_cong; |
| 958 | rc = tipc_link_xmit(&head, dnode, tsk->ref); |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 959 | if (likely(rc >= 0)) { |
| 960 | if (sock->state != SS_READY) |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 961 | sock->state = SS_CONNECTING; |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 962 | rc = dsz; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 963 | break; |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 964 | } |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 965 | if (rc == -EMSGSIZE) |
| 966 | goto new_mtu; |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 967 | if (rc != -ELINKCONG) |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 968 | break; |
Jon Paul Maloy | 50100a5 | 2014-08-22 18:09:07 -0400 | [diff] [blame] | 969 | tsk->link_cong = 1; |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 970 | rc = tipc_wait_for_sndmsg(sock, &timeo); |
Erik Hugne | 70452dc | 2014-07-06 20:38:50 -0400 | [diff] [blame] | 971 | if (rc) |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 972 | __skb_queue_purge(&head); |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 973 | } while (!rc); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 974 | exit: |
| 975 | if (iocb) |
| 976 | release_sock(sk); |
Jon Paul Maloy | e2dafe8 | 2014-06-25 20:41:37 -0500 | [diff] [blame] | 977 | |
| 978 | return rc; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 979 | } |
| 980 | |
Ying Xue | 391a6dd | 2014-01-17 09:50:06 +0800 | [diff] [blame] | 981 | static int tipc_wait_for_sndpkt(struct socket *sock, long *timeo_p) |
| 982 | { |
| 983 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 984 | struct tipc_sock *tsk = tipc_sk(sk); |
Ying Xue | 391a6dd | 2014-01-17 09:50:06 +0800 | [diff] [blame] | 985 | DEFINE_WAIT(wait); |
| 986 | int done; |
| 987 | |
| 988 | do { |
| 989 | int err = sock_error(sk); |
| 990 | if (err) |
| 991 | return err; |
| 992 | if (sock->state == SS_DISCONNECTING) |
| 993 | return -EPIPE; |
| 994 | else if (sock->state != SS_CONNECTED) |
| 995 | return -ENOTCONN; |
| 996 | if (!*timeo_p) |
| 997 | return -EAGAIN; |
| 998 | if (signal_pending(current)) |
| 999 | return sock_intr_errno(*timeo_p); |
| 1000 | |
| 1001 | prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); |
| 1002 | done = sk_wait_event(sk, timeo_p, |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 1003 | (!tsk->link_cong && |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1004 | !tsk_conn_cong(tsk)) || |
| 1005 | !tsk->connected); |
Ying Xue | 391a6dd | 2014-01-17 09:50:06 +0800 | [diff] [blame] | 1006 | finish_wait(sk_sleep(sk), &wait); |
| 1007 | } while (!done); |
| 1008 | return 0; |
| 1009 | } |
| 1010 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1011 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1012 | * tipc_send_stream - send stream-oriented data |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1013 | * @iocb: (unused) |
| 1014 | * @sock: socket structure |
| 1015 | * @m: data to send |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1016 | * @dsz: total length of data to be transmitted |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1017 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1018 | * Used for SOCK_STREAM data. |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1019 | * |
| 1020 | * Returns the number of bytes sent on success (or partial success), |
Allan Stephens | 1303e8f | 2006-06-25 23:46:50 -0700 | [diff] [blame] | 1021 | * or errno if no data sent |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1022 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1023 | static int tipc_send_stream(struct kiocb *iocb, struct socket *sock, |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1024 | struct msghdr *m, size_t dsz) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1025 | { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1026 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 1027 | struct tipc_sock *tsk = tipc_sk(sk); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1028 | struct tipc_msg *mhdr = &tsk->phdr; |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1029 | struct sk_buff_head head; |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1030 | DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1031 | u32 ref = tsk->ref; |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1032 | int rc = -EINVAL; |
| 1033 | long timeo; |
| 1034 | u32 dnode; |
| 1035 | uint mtu, send, sent = 0; |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1036 | |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1037 | /* Handle implied connection establishment */ |
| 1038 | if (unlikely(dest)) { |
| 1039 | rc = tipc_sendmsg(iocb, sock, m, dsz); |
| 1040 | if (dsz && (dsz == rc)) |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 1041 | tsk->sent_unacked = 1; |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1042 | return rc; |
| 1043 | } |
| 1044 | if (dsz > (uint)INT_MAX) |
| 1045 | return -EMSGSIZE; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1046 | |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1047 | if (iocb) |
| 1048 | lock_sock(sk); |
| 1049 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1050 | if (unlikely(sock->state != SS_CONNECTED)) { |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1051 | if (sock->state == SS_DISCONNECTING) |
| 1052 | rc = -EPIPE; |
wangweidong | b055597 | 2013-12-27 10:09:39 +0800 | [diff] [blame] | 1053 | else |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1054 | rc = -ENOTCONN; |
wangweidong | 3b8401f | 2013-12-12 09:36:40 +0800 | [diff] [blame] | 1055 | goto exit; |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1056 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1057 | |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1058 | timeo = sock_sndtimeo(sk, m->msg_flags & MSG_DONTWAIT); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1059 | dnode = tsk_peer_node(tsk); |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1060 | |
| 1061 | next: |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1062 | mtu = tsk->max_pkt; |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1063 | send = min_t(uint, dsz - sent, TIPC_MAX_USER_MSG_SIZE); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1064 | __skb_queue_head_init(&head); |
| 1065 | rc = tipc_msg_build(mhdr, m, sent, send, mtu, &head); |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1066 | if (unlikely(rc < 0)) |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1067 | goto exit; |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1068 | do { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1069 | if (likely(!tsk_conn_cong(tsk))) { |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1070 | rc = tipc_link_xmit(&head, dnode, ref); |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1071 | if (likely(!rc)) { |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 1072 | tsk->sent_unacked++; |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1073 | sent += send; |
| 1074 | if (sent == dsz) |
| 1075 | break; |
| 1076 | goto next; |
Allan Stephens | 1303e8f | 2006-06-25 23:46:50 -0700 | [diff] [blame] | 1077 | } |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1078 | if (rc == -EMSGSIZE) { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1079 | tsk->max_pkt = tipc_node_get_mtu(dnode, ref); |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1080 | goto next; |
| 1081 | } |
| 1082 | if (rc != -ELINKCONG) |
| 1083 | break; |
Jon Paul Maloy | 50100a5 | 2014-08-22 18:09:07 -0400 | [diff] [blame] | 1084 | tsk->link_cong = 1; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1085 | } |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1086 | rc = tipc_wait_for_sndpkt(sock, &timeo); |
Erik Hugne | 70452dc | 2014-07-06 20:38:50 -0400 | [diff] [blame] | 1087 | if (rc) |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1088 | __skb_queue_purge(&head); |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1089 | } while (!rc); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1090 | exit: |
Jon Paul Maloy | 4ccfe5e | 2014-06-25 20:41:38 -0500 | [diff] [blame] | 1091 | if (iocb) |
| 1092 | release_sock(sk); |
| 1093 | return sent ? sent : rc; |
| 1094 | } |
| 1095 | |
| 1096 | /** |
| 1097 | * tipc_send_packet - send a connection-oriented message |
| 1098 | * @iocb: if NULL, indicates that socket lock is already held |
| 1099 | * @sock: socket structure |
| 1100 | * @m: message to send |
| 1101 | * @dsz: length of data to be transmitted |
| 1102 | * |
| 1103 | * Used for SOCK_SEQPACKET messages. |
| 1104 | * |
| 1105 | * Returns the number of bytes sent on success, or errno otherwise |
| 1106 | */ |
| 1107 | static int tipc_send_packet(struct kiocb *iocb, struct socket *sock, |
| 1108 | struct msghdr *m, size_t dsz) |
| 1109 | { |
| 1110 | if (dsz > TIPC_MAX_USER_MSG_SIZE) |
| 1111 | return -EMSGSIZE; |
| 1112 | |
| 1113 | return tipc_send_stream(iocb, sock, m, dsz); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1114 | } |
| 1115 | |
Jon Paul Maloy | dadebc0 | 2014-08-22 18:09:11 -0400 | [diff] [blame] | 1116 | /* tipc_sk_finish_conn - complete the setup of a connection |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1117 | */ |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1118 | static void tipc_sk_finish_conn(struct tipc_sock *tsk, u32 peer_port, |
Jon Paul Maloy | dadebc0 | 2014-08-22 18:09:11 -0400 | [diff] [blame] | 1119 | u32 peer_node) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1120 | { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1121 | struct tipc_msg *msg = &tsk->phdr; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1122 | |
Jon Paul Maloy | dadebc0 | 2014-08-22 18:09:11 -0400 | [diff] [blame] | 1123 | msg_set_destnode(msg, peer_node); |
| 1124 | msg_set_destport(msg, peer_port); |
| 1125 | msg_set_type(msg, TIPC_CONN_MSG); |
| 1126 | msg_set_lookup_scope(msg, 0); |
| 1127 | msg_set_hdr_sz(msg, SHORT_H_SIZE); |
Jon Paul Maloy | f9fef18 | 2014-03-12 11:31:08 -0400 | [diff] [blame] | 1128 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1129 | tsk->probing_interval = CONN_PROBING_INTERVAL; |
| 1130 | tsk->probing_state = TIPC_CONN_OK; |
| 1131 | tsk->connected = 1; |
| 1132 | k_start_timer(&tsk->timer, tsk->probing_interval); |
| 1133 | tipc_node_add_conn(peer_node, tsk->ref, peer_port); |
| 1134 | tsk->max_pkt = tipc_node_get_mtu(peer_node, tsk->ref); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1135 | } |
| 1136 | |
| 1137 | /** |
| 1138 | * set_orig_addr - capture sender's address for received message |
| 1139 | * @m: descriptor for message info |
| 1140 | * @msg: received message header |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1141 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1142 | * Note: Address is not captured if not requested by receiver. |
| 1143 | */ |
Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 1144 | static void set_orig_addr(struct msghdr *m, struct tipc_msg *msg) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1145 | { |
Steffen Hurrle | 342dfc3 | 2014-01-17 22:53:15 +0100 | [diff] [blame] | 1146 | DECLARE_SOCKADDR(struct sockaddr_tipc *, addr, m->msg_name); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1147 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1148 | if (addr) { |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1149 | addr->family = AF_TIPC; |
| 1150 | addr->addrtype = TIPC_ADDR_ID; |
Mathias Krause | 60085c3 | 2013-04-07 01:52:00 +0000 | [diff] [blame] | 1151 | memset(&addr->addr, 0, sizeof(addr->addr)); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1152 | addr->addr.id.ref = msg_origport(msg); |
| 1153 | addr->addr.id.node = msg_orignode(msg); |
Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 1154 | addr->addr.name.domain = 0; /* could leave uninitialized */ |
| 1155 | addr->scope = 0; /* could leave uninitialized */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1156 | m->msg_namelen = sizeof(struct sockaddr_tipc); |
| 1157 | } |
| 1158 | } |
| 1159 | |
| 1160 | /** |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1161 | * tipc_sk_anc_data_recv - optionally capture ancillary data for received message |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1162 | * @m: descriptor for message info |
| 1163 | * @msg: received message header |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1164 | * @tsk: TIPC port associated with message |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1165 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1166 | * Note: Ancillary data is not captured if not requested by receiver. |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1167 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1168 | * Returns 0 if successful, otherwise errno |
| 1169 | */ |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1170 | static int tipc_sk_anc_data_recv(struct msghdr *m, struct tipc_msg *msg, |
| 1171 | struct tipc_sock *tsk) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1172 | { |
| 1173 | u32 anc_data[3]; |
| 1174 | u32 err; |
| 1175 | u32 dest_type; |
Allan Stephens | 3546c75 | 2006-06-25 23:45:24 -0700 | [diff] [blame] | 1176 | int has_name; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1177 | int res; |
| 1178 | |
| 1179 | if (likely(m->msg_controllen == 0)) |
| 1180 | return 0; |
| 1181 | |
| 1182 | /* Optionally capture errored message object(s) */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1183 | err = msg ? msg_errcode(msg) : 0; |
| 1184 | if (unlikely(err)) { |
| 1185 | anc_data[0] = err; |
| 1186 | anc_data[1] = msg_data_sz(msg); |
Allan Stephens | 2db9983 | 2010-12-31 18:59:33 +0000 | [diff] [blame] | 1187 | res = put_cmsg(m, SOL_TIPC, TIPC_ERRINFO, 8, anc_data); |
| 1188 | if (res) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1189 | return res; |
Allan Stephens | 2db9983 | 2010-12-31 18:59:33 +0000 | [diff] [blame] | 1190 | if (anc_data[1]) { |
| 1191 | res = put_cmsg(m, SOL_TIPC, TIPC_RETDATA, anc_data[1], |
| 1192 | msg_data(msg)); |
| 1193 | if (res) |
| 1194 | return res; |
| 1195 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1196 | } |
| 1197 | |
| 1198 | /* Optionally capture message destination object */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1199 | dest_type = msg ? msg_type(msg) : TIPC_DIRECT_MSG; |
| 1200 | switch (dest_type) { |
| 1201 | case TIPC_NAMED_MSG: |
Allan Stephens | 3546c75 | 2006-06-25 23:45:24 -0700 | [diff] [blame] | 1202 | has_name = 1; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1203 | anc_data[0] = msg_nametype(msg); |
| 1204 | anc_data[1] = msg_namelower(msg); |
| 1205 | anc_data[2] = msg_namelower(msg); |
| 1206 | break; |
| 1207 | case TIPC_MCAST_MSG: |
Allan Stephens | 3546c75 | 2006-06-25 23:45:24 -0700 | [diff] [blame] | 1208 | has_name = 1; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1209 | anc_data[0] = msg_nametype(msg); |
| 1210 | anc_data[1] = msg_namelower(msg); |
| 1211 | anc_data[2] = msg_nameupper(msg); |
| 1212 | break; |
| 1213 | case TIPC_CONN_MSG: |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1214 | has_name = (tsk->conn_type != 0); |
| 1215 | anc_data[0] = tsk->conn_type; |
| 1216 | anc_data[1] = tsk->conn_instance; |
| 1217 | anc_data[2] = tsk->conn_instance; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1218 | break; |
| 1219 | default: |
Allan Stephens | 3546c75 | 2006-06-25 23:45:24 -0700 | [diff] [blame] | 1220 | has_name = 0; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1221 | } |
Allan Stephens | 2db9983 | 2010-12-31 18:59:33 +0000 | [diff] [blame] | 1222 | if (has_name) { |
| 1223 | res = put_cmsg(m, SOL_TIPC, TIPC_DESTNAME, 12, anc_data); |
| 1224 | if (res) |
| 1225 | return res; |
| 1226 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1227 | |
| 1228 | return 0; |
| 1229 | } |
| 1230 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1231 | static void tipc_sk_send_ack(struct tipc_sock *tsk, uint ack) |
Jon Paul Maloy | 739f5e4 | 2014-08-22 18:09:12 -0400 | [diff] [blame] | 1232 | { |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1233 | struct sk_buff *skb = NULL; |
Jon Paul Maloy | 739f5e4 | 2014-08-22 18:09:12 -0400 | [diff] [blame] | 1234 | struct tipc_msg *msg; |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1235 | u32 peer_port = tsk_peer_port(tsk); |
| 1236 | u32 dnode = tsk_peer_node(tsk); |
Jon Paul Maloy | 739f5e4 | 2014-08-22 18:09:12 -0400 | [diff] [blame] | 1237 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1238 | if (!tsk->connected) |
Jon Paul Maloy | 739f5e4 | 2014-08-22 18:09:12 -0400 | [diff] [blame] | 1239 | return; |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1240 | skb = tipc_msg_create(CONN_MANAGER, CONN_ACK, INT_H_SIZE, 0, dnode, |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1241 | tipc_own_addr, peer_port, tsk->ref, TIPC_OK); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1242 | if (!skb) |
Jon Paul Maloy | 739f5e4 | 2014-08-22 18:09:12 -0400 | [diff] [blame] | 1243 | return; |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1244 | msg = buf_msg(skb); |
Jon Paul Maloy | 739f5e4 | 2014-08-22 18:09:12 -0400 | [diff] [blame] | 1245 | msg_set_msgcnt(msg, ack); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1246 | tipc_link_xmit_skb(skb, dnode, msg_link_selector(msg)); |
Jon Paul Maloy | 739f5e4 | 2014-08-22 18:09:12 -0400 | [diff] [blame] | 1247 | } |
| 1248 | |
Arnaldo Carvalho de Melo | 85d3fc9 | 2014-05-23 15:55:12 -0400 | [diff] [blame] | 1249 | static int tipc_wait_for_rcvmsg(struct socket *sock, long *timeop) |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1250 | { |
| 1251 | struct sock *sk = sock->sk; |
| 1252 | DEFINE_WAIT(wait); |
Arnaldo Carvalho de Melo | 85d3fc9 | 2014-05-23 15:55:12 -0400 | [diff] [blame] | 1253 | long timeo = *timeop; |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1254 | int err; |
| 1255 | |
| 1256 | for (;;) { |
| 1257 | prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); |
Ying Xue | fe8e464 | 2014-03-06 14:40:18 +0100 | [diff] [blame] | 1258 | if (timeo && skb_queue_empty(&sk->sk_receive_queue)) { |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1259 | if (sock->state == SS_DISCONNECTING) { |
| 1260 | err = -ENOTCONN; |
| 1261 | break; |
| 1262 | } |
| 1263 | release_sock(sk); |
| 1264 | timeo = schedule_timeout(timeo); |
| 1265 | lock_sock(sk); |
| 1266 | } |
| 1267 | err = 0; |
| 1268 | if (!skb_queue_empty(&sk->sk_receive_queue)) |
| 1269 | break; |
| 1270 | err = sock_intr_errno(timeo); |
| 1271 | if (signal_pending(current)) |
| 1272 | break; |
| 1273 | err = -EAGAIN; |
| 1274 | if (!timeo) |
| 1275 | break; |
| 1276 | } |
| 1277 | finish_wait(sk_sleep(sk), &wait); |
Arnaldo Carvalho de Melo | 85d3fc9 | 2014-05-23 15:55:12 -0400 | [diff] [blame] | 1278 | *timeop = timeo; |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1279 | return err; |
| 1280 | } |
| 1281 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1282 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1283 | * tipc_recvmsg - receive packet-oriented message |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1284 | * @iocb: (unused) |
| 1285 | * @m: descriptor for message info |
| 1286 | * @buf_len: total size of user buffer area |
| 1287 | * @flags: receive flags |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1288 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1289 | * Used for SOCK_DGRAM, SOCK_RDM, and SOCK_SEQPACKET messages. |
| 1290 | * If the complete message doesn't fit in user area, truncate it. |
| 1291 | * |
| 1292 | * Returns size of returned message data, errno otherwise |
| 1293 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1294 | static int tipc_recvmsg(struct kiocb *iocb, struct socket *sock, |
| 1295 | struct msghdr *m, size_t buf_len, int flags) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1296 | { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1297 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 1298 | struct tipc_sock *tsk = tipc_sk(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1299 | struct sk_buff *buf; |
| 1300 | struct tipc_msg *msg; |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1301 | long timeo; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1302 | unsigned int sz; |
| 1303 | u32 err; |
| 1304 | int res; |
| 1305 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1306 | /* Catch invalid receive requests */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1307 | if (unlikely(!buf_len)) |
| 1308 | return -EINVAL; |
| 1309 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1310 | lock_sock(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1311 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1312 | if (unlikely(sock->state == SS_UNCONNECTED)) { |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1313 | res = -ENOTCONN; |
| 1314 | goto exit; |
| 1315 | } |
| 1316 | |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1317 | timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1318 | restart: |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1319 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1320 | /* Look for a message in receive queue; wait if necessary */ |
Arnaldo Carvalho de Melo | 85d3fc9 | 2014-05-23 15:55:12 -0400 | [diff] [blame] | 1321 | res = tipc_wait_for_rcvmsg(sock, &timeo); |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1322 | if (res) |
| 1323 | goto exit; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1324 | |
| 1325 | /* Look at first message in receive queue */ |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1326 | buf = skb_peek(&sk->sk_receive_queue); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1327 | msg = buf_msg(buf); |
| 1328 | sz = msg_data_sz(msg); |
| 1329 | err = msg_errcode(msg); |
| 1330 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1331 | /* Discard an empty non-errored message & try again */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1332 | if ((!sz) && (!err)) { |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 1333 | tsk_advance_rx_queue(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1334 | goto restart; |
| 1335 | } |
| 1336 | |
| 1337 | /* Capture sender's address (optional) */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1338 | set_orig_addr(m, msg); |
| 1339 | |
| 1340 | /* Capture ancillary data (optional) */ |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1341 | res = tipc_sk_anc_data_recv(m, msg, tsk); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1342 | if (res) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1343 | goto exit; |
| 1344 | |
| 1345 | /* Capture message data (if valid) & compute return value (always) */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1346 | if (!err) { |
| 1347 | if (unlikely(buf_len < sz)) { |
| 1348 | sz = buf_len; |
| 1349 | m->msg_flags |= MSG_TRUNC; |
| 1350 | } |
David S. Miller | 51f3d02 | 2014-11-05 16:46:40 -0500 | [diff] [blame] | 1351 | res = skb_copy_datagram_msg(buf, msg_hdr_sz(msg), m, sz); |
Allan Stephens | 0232fd0 | 2011-02-21 09:45:40 -0500 | [diff] [blame] | 1352 | if (res) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1353 | goto exit; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1354 | res = sz; |
| 1355 | } else { |
| 1356 | if ((sock->state == SS_READY) || |
| 1357 | ((err == TIPC_CONN_SHUTDOWN) || m->msg_control)) |
| 1358 | res = 0; |
| 1359 | else |
| 1360 | res = -ECONNRESET; |
| 1361 | } |
| 1362 | |
| 1363 | /* Consume received message (optional) */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1364 | if (likely(!(flags & MSG_PEEK))) { |
Allan Stephens | 99009806 | 2008-04-15 00:06:12 -0700 | [diff] [blame] | 1365 | if ((sock->state != SS_READY) && |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 1366 | (++tsk->rcv_unacked >= TIPC_CONNACK_INTV)) { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1367 | tipc_sk_send_ack(tsk, tsk->rcv_unacked); |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 1368 | tsk->rcv_unacked = 0; |
| 1369 | } |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 1370 | tsk_advance_rx_queue(sk); |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1371 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1372 | exit: |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1373 | release_sock(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1374 | return res; |
| 1375 | } |
| 1376 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1377 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1378 | * tipc_recv_stream - receive stream-oriented data |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1379 | * @iocb: (unused) |
| 1380 | * @m: descriptor for message info |
| 1381 | * @buf_len: total size of user buffer area |
| 1382 | * @flags: receive flags |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1383 | * |
| 1384 | * Used for SOCK_STREAM messages only. If not enough data is available |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1385 | * will optionally wait for more; never truncates data. |
| 1386 | * |
| 1387 | * Returns size of returned message data, errno otherwise |
| 1388 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1389 | static int tipc_recv_stream(struct kiocb *iocb, struct socket *sock, |
| 1390 | struct msghdr *m, size_t buf_len, int flags) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1391 | { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1392 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 1393 | struct tipc_sock *tsk = tipc_sk(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1394 | struct sk_buff *buf; |
| 1395 | struct tipc_msg *msg; |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1396 | long timeo; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1397 | unsigned int sz; |
Florian Westphal | 3720d40 | 2010-08-17 11:00:04 +0000 | [diff] [blame] | 1398 | int sz_to_copy, target, needed; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1399 | int sz_copied = 0; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1400 | u32 err; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1401 | int res = 0; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1402 | |
| 1403 | /* Catch invalid receive attempts */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1404 | if (unlikely(!buf_len)) |
| 1405 | return -EINVAL; |
| 1406 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1407 | lock_sock(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1408 | |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1409 | if (unlikely(sock->state == SS_UNCONNECTED)) { |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1410 | res = -ENOTCONN; |
| 1411 | goto exit; |
| 1412 | } |
| 1413 | |
Florian Westphal | 3720d40 | 2010-08-17 11:00:04 +0000 | [diff] [blame] | 1414 | target = sock_rcvlowat(sk, flags & MSG_WAITALL, buf_len); |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1415 | timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT); |
Paul Gortmaker | 617d3c7 | 2012-04-30 15:29:02 -0400 | [diff] [blame] | 1416 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1417 | restart: |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1418 | /* Look for a message in receive queue; wait if necessary */ |
Arnaldo Carvalho de Melo | 85d3fc9 | 2014-05-23 15:55:12 -0400 | [diff] [blame] | 1419 | res = tipc_wait_for_rcvmsg(sock, &timeo); |
Ying Xue | 9bbb4ec | 2014-01-17 09:50:07 +0800 | [diff] [blame] | 1420 | if (res) |
| 1421 | goto exit; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1422 | |
| 1423 | /* Look at first message in receive queue */ |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1424 | buf = skb_peek(&sk->sk_receive_queue); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1425 | msg = buf_msg(buf); |
| 1426 | sz = msg_data_sz(msg); |
| 1427 | err = msg_errcode(msg); |
| 1428 | |
| 1429 | /* Discard an empty non-errored message & try again */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1430 | if ((!sz) && (!err)) { |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 1431 | tsk_advance_rx_queue(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1432 | goto restart; |
| 1433 | } |
| 1434 | |
| 1435 | /* Optionally capture sender's address & ancillary data of first msg */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1436 | if (sz_copied == 0) { |
| 1437 | set_orig_addr(m, msg); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1438 | res = tipc_sk_anc_data_recv(m, msg, tsk); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1439 | if (res) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1440 | goto exit; |
| 1441 | } |
| 1442 | |
| 1443 | /* Capture message data (if valid) & compute return value (always) */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1444 | if (!err) { |
Allan Stephens | 0232fd0 | 2011-02-21 09:45:40 -0500 | [diff] [blame] | 1445 | u32 offset = (u32)(unsigned long)(TIPC_SKB_CB(buf)->handle); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1446 | |
Allan Stephens | 0232fd0 | 2011-02-21 09:45:40 -0500 | [diff] [blame] | 1447 | sz -= offset; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1448 | needed = (buf_len - sz_copied); |
| 1449 | sz_to_copy = (sz <= needed) ? sz : needed; |
Allan Stephens | 0232fd0 | 2011-02-21 09:45:40 -0500 | [diff] [blame] | 1450 | |
David S. Miller | 51f3d02 | 2014-11-05 16:46:40 -0500 | [diff] [blame] | 1451 | res = skb_copy_datagram_msg(buf, msg_hdr_sz(msg) + offset, |
| 1452 | m, sz_to_copy); |
Allan Stephens | 0232fd0 | 2011-02-21 09:45:40 -0500 | [diff] [blame] | 1453 | if (res) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1454 | goto exit; |
Allan Stephens | 0232fd0 | 2011-02-21 09:45:40 -0500 | [diff] [blame] | 1455 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1456 | sz_copied += sz_to_copy; |
| 1457 | |
| 1458 | if (sz_to_copy < sz) { |
| 1459 | if (!(flags & MSG_PEEK)) |
Allan Stephens | 0232fd0 | 2011-02-21 09:45:40 -0500 | [diff] [blame] | 1460 | TIPC_SKB_CB(buf)->handle = |
| 1461 | (void *)(unsigned long)(offset + sz_to_copy); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1462 | goto exit; |
| 1463 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1464 | } else { |
| 1465 | if (sz_copied != 0) |
| 1466 | goto exit; /* can't add error msg to valid data */ |
| 1467 | |
| 1468 | if ((err == TIPC_CONN_SHUTDOWN) || m->msg_control) |
| 1469 | res = 0; |
| 1470 | else |
| 1471 | res = -ECONNRESET; |
| 1472 | } |
| 1473 | |
| 1474 | /* Consume received message (optional) */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1475 | if (likely(!(flags & MSG_PEEK))) { |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 1476 | if (unlikely(++tsk->rcv_unacked >= TIPC_CONNACK_INTV)) { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1477 | tipc_sk_send_ack(tsk, tsk->rcv_unacked); |
Jon Paul Maloy | 6012052 | 2014-06-25 20:41:42 -0500 | [diff] [blame] | 1478 | tsk->rcv_unacked = 0; |
| 1479 | } |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 1480 | tsk_advance_rx_queue(sk); |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1481 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1482 | |
| 1483 | /* Loop around if more data is required */ |
Joe Perches | f64f9e7 | 2009-11-29 16:55:45 -0800 | [diff] [blame] | 1484 | if ((sz_copied < buf_len) && /* didn't get all requested data */ |
| 1485 | (!skb_queue_empty(&sk->sk_receive_queue) || |
Florian Westphal | 3720d40 | 2010-08-17 11:00:04 +0000 | [diff] [blame] | 1486 | (sz_copied < target)) && /* and more is ready or required */ |
Joe Perches | f64f9e7 | 2009-11-29 16:55:45 -0800 | [diff] [blame] | 1487 | (!(flags & MSG_PEEK)) && /* and aren't just peeking at data */ |
| 1488 | (!err)) /* and haven't reached a FIN */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1489 | goto restart; |
| 1490 | |
| 1491 | exit: |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1492 | release_sock(sk); |
Allan Stephens | a3b0a5a | 2006-06-25 23:48:22 -0700 | [diff] [blame] | 1493 | return sz_copied ? sz_copied : res; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1494 | } |
| 1495 | |
| 1496 | /** |
Ying Xue | f288bef | 2012-08-21 11:16:57 +0800 | [diff] [blame] | 1497 | * tipc_write_space - wake up thread if port congestion is released |
| 1498 | * @sk: socket |
| 1499 | */ |
| 1500 | static void tipc_write_space(struct sock *sk) |
| 1501 | { |
| 1502 | struct socket_wq *wq; |
| 1503 | |
| 1504 | rcu_read_lock(); |
| 1505 | wq = rcu_dereference(sk->sk_wq); |
| 1506 | if (wq_has_sleeper(wq)) |
| 1507 | wake_up_interruptible_sync_poll(&wq->wait, POLLOUT | |
| 1508 | POLLWRNORM | POLLWRBAND); |
| 1509 | rcu_read_unlock(); |
| 1510 | } |
| 1511 | |
| 1512 | /** |
| 1513 | * tipc_data_ready - wake up threads to indicate messages have been received |
| 1514 | * @sk: socket |
| 1515 | * @len: the length of messages |
| 1516 | */ |
David S. Miller | 676d236 | 2014-04-11 16:15:36 -0400 | [diff] [blame] | 1517 | static void tipc_data_ready(struct sock *sk) |
Ying Xue | f288bef | 2012-08-21 11:16:57 +0800 | [diff] [blame] | 1518 | { |
| 1519 | struct socket_wq *wq; |
| 1520 | |
| 1521 | rcu_read_lock(); |
| 1522 | wq = rcu_dereference(sk->sk_wq); |
| 1523 | if (wq_has_sleeper(wq)) |
| 1524 | wake_up_interruptible_sync_poll(&wq->wait, POLLIN | |
| 1525 | POLLRDNORM | POLLRDBAND); |
| 1526 | rcu_read_unlock(); |
| 1527 | } |
| 1528 | |
| 1529 | /** |
Ying Xue | 7e6c131 | 2012-11-29 18:39:14 -0500 | [diff] [blame] | 1530 | * filter_connect - Handle all incoming messages for a connection-based socket |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 1531 | * @tsk: TIPC socket |
Ying Xue | 7e6c131 | 2012-11-29 18:39:14 -0500 | [diff] [blame] | 1532 | * @msg: message |
| 1533 | * |
stephen hemminger | b2ad5e5 | 2014-10-29 22:58:51 -0700 | [diff] [blame] | 1534 | * Returns 0 (TIPC_OK) if everything ok, -TIPC_ERR_NO_PORT otherwise |
Ying Xue | 7e6c131 | 2012-11-29 18:39:14 -0500 | [diff] [blame] | 1535 | */ |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1536 | static int filter_connect(struct tipc_sock *tsk, struct sk_buff **buf) |
Ying Xue | 7e6c131 | 2012-11-29 18:39:14 -0500 | [diff] [blame] | 1537 | { |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 1538 | struct sock *sk = &tsk->sk; |
Jon Paul Maloy | 8826cde | 2014-03-12 11:31:09 -0400 | [diff] [blame] | 1539 | struct socket *sock = sk->sk_socket; |
Ying Xue | 7e6c131 | 2012-11-29 18:39:14 -0500 | [diff] [blame] | 1540 | struct tipc_msg *msg = buf_msg(*buf); |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1541 | int retval = -TIPC_ERR_NO_PORT; |
Ying Xue | 7e6c131 | 2012-11-29 18:39:14 -0500 | [diff] [blame] | 1542 | |
| 1543 | if (msg_mcast(msg)) |
| 1544 | return retval; |
| 1545 | |
| 1546 | switch ((int)sock->state) { |
| 1547 | case SS_CONNECTED: |
| 1548 | /* Accept only connection-based messages sent by peer */ |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 1549 | if (tsk_peer_msg(tsk, msg)) { |
Ying Xue | 7e6c131 | 2012-11-29 18:39:14 -0500 | [diff] [blame] | 1550 | if (unlikely(msg_errcode(msg))) { |
| 1551 | sock->state = SS_DISCONNECTING; |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1552 | tsk->connected = 0; |
Jon Paul Maloy | dadebc0 | 2014-08-22 18:09:11 -0400 | [diff] [blame] | 1553 | /* let timer expire on it's own */ |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1554 | tipc_node_remove_conn(tsk_peer_node(tsk), |
| 1555 | tsk->ref); |
Ying Xue | 7e6c131 | 2012-11-29 18:39:14 -0500 | [diff] [blame] | 1556 | } |
| 1557 | retval = TIPC_OK; |
| 1558 | } |
| 1559 | break; |
| 1560 | case SS_CONNECTING: |
| 1561 | /* Accept only ACK or NACK message */ |
Jon Paul Maloy | dadebc0 | 2014-08-22 18:09:11 -0400 | [diff] [blame] | 1562 | |
| 1563 | if (unlikely(!msg_connected(msg))) |
| 1564 | break; |
| 1565 | |
Ying Xue | 584d24b | 2012-11-29 18:51:19 -0500 | [diff] [blame] | 1566 | if (unlikely(msg_errcode(msg))) { |
| 1567 | sock->state = SS_DISCONNECTING; |
Erik Hugne | 2c8d851 | 2013-08-28 09:29:58 +0200 | [diff] [blame] | 1568 | sk->sk_err = ECONNREFUSED; |
Ying Xue | 7e6c131 | 2012-11-29 18:39:14 -0500 | [diff] [blame] | 1569 | retval = TIPC_OK; |
Ying Xue | 584d24b | 2012-11-29 18:51:19 -0500 | [diff] [blame] | 1570 | break; |
| 1571 | } |
| 1572 | |
Jon Paul Maloy | dadebc0 | 2014-08-22 18:09:11 -0400 | [diff] [blame] | 1573 | if (unlikely(msg_importance(msg) > TIPC_CRITICAL_IMPORTANCE)) { |
Ying Xue | 584d24b | 2012-11-29 18:51:19 -0500 | [diff] [blame] | 1574 | sock->state = SS_DISCONNECTING; |
Jon Paul Maloy | dadebc0 | 2014-08-22 18:09:11 -0400 | [diff] [blame] | 1575 | sk->sk_err = EINVAL; |
Ying Xue | 584d24b | 2012-11-29 18:51:19 -0500 | [diff] [blame] | 1576 | retval = TIPC_OK; |
| 1577 | break; |
| 1578 | } |
| 1579 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1580 | tipc_sk_finish_conn(tsk, msg_origport(msg), msg_orignode(msg)); |
| 1581 | msg_set_importance(&tsk->phdr, msg_importance(msg)); |
Jon Paul Maloy | dadebc0 | 2014-08-22 18:09:11 -0400 | [diff] [blame] | 1582 | sock->state = SS_CONNECTED; |
| 1583 | |
Ying Xue | 584d24b | 2012-11-29 18:51:19 -0500 | [diff] [blame] | 1584 | /* If an incoming message is an 'ACK-', it should be |
| 1585 | * discarded here because it doesn't contain useful |
| 1586 | * data. In addition, we should try to wake up |
| 1587 | * connect() routine if sleeping. |
| 1588 | */ |
| 1589 | if (msg_data_sz(msg) == 0) { |
| 1590 | kfree_skb(*buf); |
| 1591 | *buf = NULL; |
| 1592 | if (waitqueue_active(sk_sleep(sk))) |
| 1593 | wake_up_interruptible(sk_sleep(sk)); |
| 1594 | } |
| 1595 | retval = TIPC_OK; |
Ying Xue | 7e6c131 | 2012-11-29 18:39:14 -0500 | [diff] [blame] | 1596 | break; |
| 1597 | case SS_LISTENING: |
| 1598 | case SS_UNCONNECTED: |
| 1599 | /* Accept only SYN message */ |
| 1600 | if (!msg_connected(msg) && !(msg_errcode(msg))) |
| 1601 | retval = TIPC_OK; |
| 1602 | break; |
| 1603 | case SS_DISCONNECTING: |
| 1604 | break; |
| 1605 | default: |
| 1606 | pr_err("Unknown socket state %u\n", sock->state); |
| 1607 | } |
| 1608 | return retval; |
| 1609 | } |
| 1610 | |
| 1611 | /** |
Ying Xue | aba79f3 | 2013-01-20 23:30:09 +0100 | [diff] [blame] | 1612 | * rcvbuf_limit - get proper overload limit of socket receive queue |
| 1613 | * @sk: socket |
| 1614 | * @buf: message |
| 1615 | * |
| 1616 | * For all connection oriented messages, irrespective of importance, |
| 1617 | * the default overload value (i.e. 67MB) is set as limit. |
| 1618 | * |
| 1619 | * For all connectionless messages, by default new queue limits are |
| 1620 | * as belows: |
| 1621 | * |
Ying Xue | cc79dd1 | 2013-06-17 10:54:37 -0400 | [diff] [blame] | 1622 | * TIPC_LOW_IMPORTANCE (4 MB) |
| 1623 | * TIPC_MEDIUM_IMPORTANCE (8 MB) |
| 1624 | * TIPC_HIGH_IMPORTANCE (16 MB) |
| 1625 | * TIPC_CRITICAL_IMPORTANCE (32 MB) |
Ying Xue | aba79f3 | 2013-01-20 23:30:09 +0100 | [diff] [blame] | 1626 | * |
| 1627 | * Returns overload limit according to corresponding message importance |
| 1628 | */ |
| 1629 | static unsigned int rcvbuf_limit(struct sock *sk, struct sk_buff *buf) |
| 1630 | { |
| 1631 | struct tipc_msg *msg = buf_msg(buf); |
Ying Xue | aba79f3 | 2013-01-20 23:30:09 +0100 | [diff] [blame] | 1632 | |
| 1633 | if (msg_connected(msg)) |
wangweidong | 0cee6bb | 2013-12-12 09:36:39 +0800 | [diff] [blame] | 1634 | return sysctl_tipc_rmem[2]; |
| 1635 | |
| 1636 | return sk->sk_rcvbuf >> TIPC_CRITICAL_IMPORTANCE << |
| 1637 | msg_importance(msg); |
Ying Xue | aba79f3 | 2013-01-20 23:30:09 +0100 | [diff] [blame] | 1638 | } |
| 1639 | |
| 1640 | /** |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1641 | * filter_rcv - validate incoming message |
| 1642 | * @sk: socket |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1643 | * @buf: message |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1644 | * |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1645 | * Enqueues message on receive queue if acceptable; optionally handles |
| 1646 | * disconnect indication for a connected socket. |
| 1647 | * |
| 1648 | * Called with socket lock already taken; port lock may also be taken. |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1649 | * |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1650 | * Returns 0 (TIPC_OK) if message was consumed, -TIPC error code if message |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 1651 | * to be rejected, 1 (TIPC_FWD_MSG) if (CONN_MANAGER) message to be forwarded |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1652 | */ |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1653 | static int filter_rcv(struct sock *sk, struct sk_buff *buf) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1654 | { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1655 | struct socket *sock = sk->sk_socket; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 1656 | struct tipc_sock *tsk = tipc_sk(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1657 | struct tipc_msg *msg = buf_msg(buf); |
Ying Xue | aba79f3 | 2013-01-20 23:30:09 +0100 | [diff] [blame] | 1658 | unsigned int limit = rcvbuf_limit(sk, buf); |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 1659 | u32 onode; |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1660 | int rc = TIPC_OK; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1661 | |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 1662 | if (unlikely(msg_user(msg) == CONN_MANAGER)) |
| 1663 | return tipc_sk_proto_rcv(tsk, &onode, buf); |
Jon Paul Maloy | ec8a2e5 | 2014-06-25 20:41:40 -0500 | [diff] [blame] | 1664 | |
Jon Paul Maloy | 50100a5 | 2014-08-22 18:09:07 -0400 | [diff] [blame] | 1665 | if (unlikely(msg_user(msg) == SOCK_WAKEUP)) { |
| 1666 | kfree_skb(buf); |
| 1667 | tsk->link_cong = 0; |
| 1668 | sk->sk_write_space(sk); |
| 1669 | return TIPC_OK; |
| 1670 | } |
| 1671 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1672 | /* Reject message if it is wrong sort of message for socket */ |
Allan Stephens | aad5854 | 2012-04-26 18:13:08 -0400 | [diff] [blame] | 1673 | if (msg_type(msg) > TIPC_DIRECT_MSG) |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1674 | return -TIPC_ERR_NO_PORT; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1675 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1676 | if (sock->state == SS_READY) { |
Allan Stephens | b29f1428 | 2010-12-31 18:59:25 +0000 | [diff] [blame] | 1677 | if (msg_connected(msg)) |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1678 | return -TIPC_ERR_NO_PORT; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1679 | } else { |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1680 | rc = filter_connect(tsk, &buf); |
| 1681 | if (rc != TIPC_OK || buf == NULL) |
| 1682 | return rc; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1683 | } |
| 1684 | |
| 1685 | /* Reject message if there isn't room to queue it */ |
Ying Xue | aba79f3 | 2013-01-20 23:30:09 +0100 | [diff] [blame] | 1686 | if (sk_rmem_alloc_get(sk) + buf->truesize >= limit) |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1687 | return -TIPC_ERR_OVERLOAD; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1688 | |
Ying Xue | aba79f3 | 2013-01-20 23:30:09 +0100 | [diff] [blame] | 1689 | /* Enqueue message */ |
Ying Xue | 4068243 | 2013-10-18 07:23:16 +0200 | [diff] [blame] | 1690 | TIPC_SKB_CB(buf)->handle = NULL; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1691 | __skb_queue_tail(&sk->sk_receive_queue, buf); |
Ying Xue | aba79f3 | 2013-01-20 23:30:09 +0100 | [diff] [blame] | 1692 | skb_set_owner_r(buf, sk); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1693 | |
David S. Miller | 676d236 | 2014-04-11 16:15:36 -0400 | [diff] [blame] | 1694 | sk->sk_data_ready(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1695 | return TIPC_OK; |
| 1696 | } |
| 1697 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1698 | /** |
Jon Paul Maloy | 4f4482d | 2014-05-14 05:39:09 -0400 | [diff] [blame] | 1699 | * tipc_backlog_rcv - handle incoming message from backlog queue |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1700 | * @sk: socket |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1701 | * @skb: message |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1702 | * |
| 1703 | * Caller must hold socket lock, but not port lock. |
| 1704 | * |
| 1705 | * Returns 0 |
| 1706 | */ |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1707 | static int tipc_backlog_rcv(struct sock *sk, struct sk_buff *skb) |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1708 | { |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1709 | int rc; |
Jon Paul Maloy | 8db1bae | 2014-06-25 20:41:35 -0500 | [diff] [blame] | 1710 | u32 onode; |
Jon Paul Maloy | 4f4482d | 2014-05-14 05:39:09 -0400 | [diff] [blame] | 1711 | struct tipc_sock *tsk = tipc_sk(sk); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1712 | uint truesize = skb->truesize; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1713 | |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1714 | rc = filter_rcv(sk, skb); |
Jon Paul Maloy | 4f4482d | 2014-05-14 05:39:09 -0400 | [diff] [blame] | 1715 | |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 1716 | if (likely(!rc)) { |
| 1717 | if (atomic_read(&tsk->dupl_rcvcnt) < TIPC_CONN_OVERLOAD_LIMIT) |
| 1718 | atomic_add(truesize, &tsk->dupl_rcvcnt); |
| 1719 | return 0; |
| 1720 | } |
| 1721 | |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1722 | if ((rc < 0) && !tipc_msg_reverse(skb, &onode, -rc)) |
Jon Paul Maloy | ac0074e | 2014-06-25 20:41:41 -0500 | [diff] [blame] | 1723 | return 0; |
| 1724 | |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1725 | tipc_link_xmit_skb(skb, onode, 0); |
Jon Paul Maloy | 4f4482d | 2014-05-14 05:39:09 -0400 | [diff] [blame] | 1726 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1727 | return 0; |
| 1728 | } |
| 1729 | |
| 1730 | /** |
Jon Paul Maloy | 24be34b | 2014-03-12 11:31:10 -0400 | [diff] [blame] | 1731 | * tipc_sk_rcv - handle incoming message |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1732 | * @skb: buffer containing arriving message |
Jon Paul Maloy | 9816f06 | 2014-05-14 05:39:15 -0400 | [diff] [blame] | 1733 | * Consumes buffer |
| 1734 | * Returns 0 if success, or errno: -EHOSTUNREACH |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1735 | */ |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1736 | int tipc_sk_rcv(struct sk_buff *skb) |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1737 | { |
Jon Paul Maloy | 9816f06 | 2014-05-14 05:39:15 -0400 | [diff] [blame] | 1738 | struct tipc_sock *tsk; |
Jon Paul Maloy | 9816f06 | 2014-05-14 05:39:15 -0400 | [diff] [blame] | 1739 | struct sock *sk; |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1740 | u32 dport = msg_destport(buf_msg(skb)); |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1741 | int rc = TIPC_OK; |
Jon Paul Maloy | 4f4482d | 2014-05-14 05:39:09 -0400 | [diff] [blame] | 1742 | uint limit; |
Jon Paul Maloy | 8db1bae | 2014-06-25 20:41:35 -0500 | [diff] [blame] | 1743 | u32 dnode; |
Jon Paul Maloy | 9816f06 | 2014-05-14 05:39:15 -0400 | [diff] [blame] | 1744 | |
Jon Paul Maloy | 5a37907 | 2014-06-25 20:41:36 -0500 | [diff] [blame] | 1745 | /* Validate destination and message */ |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 1746 | tsk = tipc_sk_get(dport); |
Jon Paul Maloy | 9b50fd0 | 2014-08-22 18:09:15 -0400 | [diff] [blame] | 1747 | if (unlikely(!tsk)) { |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1748 | rc = tipc_msg_eval(skb, &dnode); |
Jon Paul Maloy | 9816f06 | 2014-05-14 05:39:15 -0400 | [diff] [blame] | 1749 | goto exit; |
| 1750 | } |
Jon Paul Maloy | 9816f06 | 2014-05-14 05:39:15 -0400 | [diff] [blame] | 1751 | sk = &tsk->sk; |
| 1752 | |
| 1753 | /* Queue message */ |
Ying Xue | 1a194c2 | 2014-10-20 14:46:35 +0800 | [diff] [blame] | 1754 | spin_lock_bh(&sk->sk_lock.slock); |
Jon Paul Maloy | 9816f06 | 2014-05-14 05:39:15 -0400 | [diff] [blame] | 1755 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1756 | if (!sock_owned_by_user(sk)) { |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1757 | rc = filter_rcv(sk, skb); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1758 | } else { |
Jon Paul Maloy | 4f4482d | 2014-05-14 05:39:09 -0400 | [diff] [blame] | 1759 | if (sk->sk_backlog.len == 0) |
| 1760 | atomic_set(&tsk->dupl_rcvcnt, 0); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1761 | limit = rcvbuf_limit(sk, skb) + atomic_read(&tsk->dupl_rcvcnt); |
| 1762 | if (sk_add_backlog(sk, skb, limit)) |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1763 | rc = -TIPC_ERR_OVERLOAD; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1764 | } |
Ying Xue | 1a194c2 | 2014-10-20 14:46:35 +0800 | [diff] [blame] | 1765 | spin_unlock_bh(&sk->sk_lock.slock); |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 1766 | tipc_sk_put(tsk); |
Jon Paul Maloy | e4de5fa | 2014-06-25 20:41:31 -0500 | [diff] [blame] | 1767 | if (likely(!rc)) |
Jon Paul Maloy | 9816f06 | 2014-05-14 05:39:15 -0400 | [diff] [blame] | 1768 | return 0; |
| 1769 | exit: |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1770 | if ((rc < 0) && !tipc_msg_reverse(skb, &dnode, -rc)) |
Jon Paul Maloy | 8db1bae | 2014-06-25 20:41:35 -0500 | [diff] [blame] | 1771 | return -EHOSTUNREACH; |
Jon Paul Maloy | 5a37907 | 2014-06-25 20:41:36 -0500 | [diff] [blame] | 1772 | |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 1773 | tipc_link_xmit_skb(skb, dnode, 0); |
Jon Paul Maloy | 5a37907 | 2014-06-25 20:41:36 -0500 | [diff] [blame] | 1774 | return (rc < 0) ? -EHOSTUNREACH : 0; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1775 | } |
| 1776 | |
Ying Xue | 78eb3a5 | 2014-01-17 09:50:03 +0800 | [diff] [blame] | 1777 | static int tipc_wait_for_connect(struct socket *sock, long *timeo_p) |
| 1778 | { |
| 1779 | struct sock *sk = sock->sk; |
| 1780 | DEFINE_WAIT(wait); |
| 1781 | int done; |
| 1782 | |
| 1783 | do { |
| 1784 | int err = sock_error(sk); |
| 1785 | if (err) |
| 1786 | return err; |
| 1787 | if (!*timeo_p) |
| 1788 | return -ETIMEDOUT; |
| 1789 | if (signal_pending(current)) |
| 1790 | return sock_intr_errno(*timeo_p); |
| 1791 | |
| 1792 | prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE); |
| 1793 | done = sk_wait_event(sk, timeo_p, sock->state != SS_CONNECTING); |
| 1794 | finish_wait(sk_sleep(sk), &wait); |
| 1795 | } while (!done); |
| 1796 | return 0; |
| 1797 | } |
| 1798 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1799 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1800 | * tipc_connect - establish a connection to another TIPC port |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1801 | * @sock: socket structure |
| 1802 | * @dest: socket address for destination port |
| 1803 | * @destlen: size of socket address data structure |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1804 | * @flags: file-related flags associated with socket |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1805 | * |
| 1806 | * Returns 0 on success, errno otherwise |
| 1807 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1808 | static int tipc_connect(struct socket *sock, struct sockaddr *dest, |
| 1809 | int destlen, int flags) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1810 | { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1811 | struct sock *sk = sock->sk; |
Allan Stephens | b89741a | 2008-04-15 00:20:37 -0700 | [diff] [blame] | 1812 | struct sockaddr_tipc *dst = (struct sockaddr_tipc *)dest; |
| 1813 | struct msghdr m = {NULL,}; |
Ying Xue | 78eb3a5 | 2014-01-17 09:50:03 +0800 | [diff] [blame] | 1814 | long timeout = (flags & O_NONBLOCK) ? 0 : tipc_sk(sk)->conn_timeout; |
| 1815 | socket_state previous; |
Allan Stephens | b89741a | 2008-04-15 00:20:37 -0700 | [diff] [blame] | 1816 | int res; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1817 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1818 | lock_sock(sk); |
| 1819 | |
Allan Stephens | b89741a | 2008-04-15 00:20:37 -0700 | [diff] [blame] | 1820 | /* For now, TIPC does not allow use of connect() with DGRAM/RDM types */ |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1821 | if (sock->state == SS_READY) { |
| 1822 | res = -EOPNOTSUPP; |
| 1823 | goto exit; |
| 1824 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1825 | |
Allan Stephens | b89741a | 2008-04-15 00:20:37 -0700 | [diff] [blame] | 1826 | /* |
| 1827 | * Reject connection attempt using multicast address |
| 1828 | * |
| 1829 | * Note: send_msg() validates the rest of the address fields, |
| 1830 | * so there's no need to do it here |
| 1831 | */ |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1832 | if (dst->addrtype == TIPC_ADDR_MCAST) { |
| 1833 | res = -EINVAL; |
| 1834 | goto exit; |
| 1835 | } |
| 1836 | |
Ying Xue | 78eb3a5 | 2014-01-17 09:50:03 +0800 | [diff] [blame] | 1837 | previous = sock->state; |
Ying Xue | 584d24b | 2012-11-29 18:51:19 -0500 | [diff] [blame] | 1838 | switch (sock->state) { |
| 1839 | case SS_UNCONNECTED: |
| 1840 | /* Send a 'SYN-' to destination */ |
| 1841 | m.msg_name = dest; |
| 1842 | m.msg_namelen = destlen; |
| 1843 | |
| 1844 | /* If connect is in non-blocking case, set MSG_DONTWAIT to |
| 1845 | * indicate send_msg() is never blocked. |
| 1846 | */ |
| 1847 | if (!timeout) |
| 1848 | m.msg_flags = MSG_DONTWAIT; |
| 1849 | |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1850 | res = tipc_sendmsg(NULL, sock, &m, 0); |
Ying Xue | 584d24b | 2012-11-29 18:51:19 -0500 | [diff] [blame] | 1851 | if ((res < 0) && (res != -EWOULDBLOCK)) |
| 1852 | goto exit; |
| 1853 | |
| 1854 | /* Just entered SS_CONNECTING state; the only |
| 1855 | * difference is that return value in non-blocking |
| 1856 | * case is EINPROGRESS, rather than EALREADY. |
| 1857 | */ |
| 1858 | res = -EINPROGRESS; |
Ying Xue | 584d24b | 2012-11-29 18:51:19 -0500 | [diff] [blame] | 1859 | case SS_CONNECTING: |
Ying Xue | 78eb3a5 | 2014-01-17 09:50:03 +0800 | [diff] [blame] | 1860 | if (previous == SS_CONNECTING) |
| 1861 | res = -EALREADY; |
| 1862 | if (!timeout) |
| 1863 | goto exit; |
| 1864 | timeout = msecs_to_jiffies(timeout); |
| 1865 | /* Wait until an 'ACK' or 'RST' arrives, or a timeout occurs */ |
| 1866 | res = tipc_wait_for_connect(sock, &timeout); |
Ying Xue | 584d24b | 2012-11-29 18:51:19 -0500 | [diff] [blame] | 1867 | break; |
| 1868 | case SS_CONNECTED: |
| 1869 | res = -EISCONN; |
| 1870 | break; |
| 1871 | default: |
| 1872 | res = -EINVAL; |
Ying Xue | 78eb3a5 | 2014-01-17 09:50:03 +0800 | [diff] [blame] | 1873 | break; |
Allan Stephens | b89741a | 2008-04-15 00:20:37 -0700 | [diff] [blame] | 1874 | } |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1875 | exit: |
| 1876 | release_sock(sk); |
Allan Stephens | b89741a | 2008-04-15 00:20:37 -0700 | [diff] [blame] | 1877 | return res; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1878 | } |
| 1879 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1880 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1881 | * tipc_listen - allow socket to listen for incoming connections |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1882 | * @sock: socket structure |
| 1883 | * @len: (unused) |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1884 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1885 | * Returns 0 on success, errno otherwise |
| 1886 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1887 | static int tipc_listen(struct socket *sock, int len) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1888 | { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1889 | struct sock *sk = sock->sk; |
| 1890 | int res; |
| 1891 | |
| 1892 | lock_sock(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1893 | |
Ying Xue | 245f3d3 | 2011-07-06 06:01:13 -0400 | [diff] [blame] | 1894 | if (sock->state != SS_UNCONNECTED) |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1895 | res = -EINVAL; |
| 1896 | else { |
| 1897 | sock->state = SS_LISTENING; |
| 1898 | res = 0; |
| 1899 | } |
| 1900 | |
| 1901 | release_sock(sk); |
| 1902 | return res; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1903 | } |
| 1904 | |
Ying Xue | 6398e23 | 2014-01-17 09:50:04 +0800 | [diff] [blame] | 1905 | static int tipc_wait_for_accept(struct socket *sock, long timeo) |
| 1906 | { |
| 1907 | struct sock *sk = sock->sk; |
| 1908 | DEFINE_WAIT(wait); |
| 1909 | int err; |
| 1910 | |
| 1911 | /* True wake-one mechanism for incoming connections: only |
| 1912 | * one process gets woken up, not the 'whole herd'. |
| 1913 | * Since we do not 'race & poll' for established sockets |
| 1914 | * anymore, the common case will execute the loop only once. |
| 1915 | */ |
| 1916 | for (;;) { |
| 1917 | prepare_to_wait_exclusive(sk_sleep(sk), &wait, |
| 1918 | TASK_INTERRUPTIBLE); |
Ying Xue | fe8e464 | 2014-03-06 14:40:18 +0100 | [diff] [blame] | 1919 | if (timeo && skb_queue_empty(&sk->sk_receive_queue)) { |
Ying Xue | 6398e23 | 2014-01-17 09:50:04 +0800 | [diff] [blame] | 1920 | release_sock(sk); |
| 1921 | timeo = schedule_timeout(timeo); |
| 1922 | lock_sock(sk); |
| 1923 | } |
| 1924 | err = 0; |
| 1925 | if (!skb_queue_empty(&sk->sk_receive_queue)) |
| 1926 | break; |
| 1927 | err = -EINVAL; |
| 1928 | if (sock->state != SS_LISTENING) |
| 1929 | break; |
| 1930 | err = sock_intr_errno(timeo); |
| 1931 | if (signal_pending(current)) |
| 1932 | break; |
| 1933 | err = -EAGAIN; |
| 1934 | if (!timeo) |
| 1935 | break; |
| 1936 | } |
| 1937 | finish_wait(sk_sleep(sk), &wait); |
| 1938 | return err; |
| 1939 | } |
| 1940 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1941 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1942 | * tipc_accept - wait for connection request |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1943 | * @sock: listening socket |
| 1944 | * @newsock: new socket that is to be connected |
| 1945 | * @flags: file-related flags associated with socket |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1946 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1947 | * Returns 0 on success, errno otherwise |
| 1948 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 1949 | static int tipc_accept(struct socket *sock, struct socket *new_sock, int flags) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1950 | { |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1951 | struct sock *new_sk, *sk = sock->sk; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1952 | struct sk_buff *buf; |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1953 | struct tipc_sock *new_tsock; |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1954 | struct tipc_msg *msg; |
Ying Xue | 6398e23 | 2014-01-17 09:50:04 +0800 | [diff] [blame] | 1955 | long timeo; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1956 | int res; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1957 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1958 | lock_sock(sk); |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1959 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1960 | if (sock->state != SS_LISTENING) { |
| 1961 | res = -EINVAL; |
| 1962 | goto exit; |
| 1963 | } |
Ying Xue | 6398e23 | 2014-01-17 09:50:04 +0800 | [diff] [blame] | 1964 | timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK); |
| 1965 | res = tipc_wait_for_accept(sock, timeo); |
| 1966 | if (res) |
| 1967 | goto exit; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1968 | |
| 1969 | buf = skb_peek(&sk->sk_receive_queue); |
| 1970 | |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 1971 | res = tipc_sk_create(sock_net(sock->sk), new_sock, 0, 1); |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1972 | if (res) |
| 1973 | goto exit; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1974 | |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1975 | new_sk = new_sock->sk; |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1976 | new_tsock = tipc_sk(new_sk); |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1977 | msg = buf_msg(buf); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1978 | |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1979 | /* we lock on new_sk; but lockdep sees the lock on sk */ |
| 1980 | lock_sock_nested(new_sk, SINGLE_DEPTH_NESTING); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 1981 | |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1982 | /* |
| 1983 | * Reject any stray messages received by new socket |
| 1984 | * before the socket lock was taken (very, very unlikely) |
| 1985 | */ |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 1986 | tsk_rej_rx_queue(new_sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1987 | |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1988 | /* Connect new socket to it's peer */ |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1989 | tipc_sk_finish_conn(new_tsock, msg_origport(msg), msg_orignode(msg)); |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1990 | new_sock->state = SS_CONNECTED; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1991 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1992 | tsk_set_importance(new_tsock, msg_importance(msg)); |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1993 | if (msg_named(msg)) { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 1994 | new_tsock->conn_type = msg_nametype(msg); |
| 1995 | new_tsock->conn_instance = msg_nameinst(msg); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1996 | } |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 1997 | |
| 1998 | /* |
| 1999 | * Respond to 'SYN-' by discarding it & returning 'ACK'-. |
| 2000 | * Respond to 'SYN+' by queuing it on new socket. |
| 2001 | */ |
| 2002 | if (!msg_data_sz(msg)) { |
| 2003 | struct msghdr m = {NULL,}; |
| 2004 | |
Jon Paul Maloy | 2e84c60b | 2014-08-22 18:09:18 -0400 | [diff] [blame] | 2005 | tsk_advance_rx_queue(sk); |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2006 | tipc_send_packet(NULL, new_sock, &m, 0); |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 2007 | } else { |
| 2008 | __skb_dequeue(&sk->sk_receive_queue); |
| 2009 | __skb_queue_head(&new_sk->sk_receive_queue, buf); |
Ying Xue | aba79f3 | 2013-01-20 23:30:09 +0100 | [diff] [blame] | 2010 | skb_set_owner_r(buf, new_sk); |
Paul Gortmaker | 0fef8f2 | 2012-12-04 11:01:55 -0500 | [diff] [blame] | 2011 | } |
| 2012 | release_sock(new_sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2013 | exit: |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2014 | release_sock(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2015 | return res; |
| 2016 | } |
| 2017 | |
| 2018 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2019 | * tipc_shutdown - shutdown socket connection |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2020 | * @sock: socket structure |
Allan Stephens | e247a8f | 2008-03-06 15:05:38 -0800 | [diff] [blame] | 2021 | * @how: direction to close (must be SHUT_RDWR) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2022 | * |
| 2023 | * Terminates connection (if necessary), then purges socket's receive queue. |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2024 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2025 | * Returns 0 on success, errno otherwise |
| 2026 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2027 | static int tipc_shutdown(struct socket *sock, int how) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2028 | { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2029 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 2030 | struct tipc_sock *tsk = tipc_sk(sk); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 2031 | struct sk_buff *skb; |
Jon Paul Maloy | 80e44c2 | 2014-08-22 18:09:10 -0400 | [diff] [blame] | 2032 | u32 dnode; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2033 | int res; |
| 2034 | |
Allan Stephens | e247a8f | 2008-03-06 15:05:38 -0800 | [diff] [blame] | 2035 | if (how != SHUT_RDWR) |
| 2036 | return -EINVAL; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2037 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2038 | lock_sock(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2039 | |
| 2040 | switch (sock->state) { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2041 | case SS_CONNECTING: |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2042 | case SS_CONNECTED: |
| 2043 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2044 | restart: |
Paul Gortmaker | 617d3c7 | 2012-04-30 15:29:02 -0400 | [diff] [blame] | 2045 | /* Disconnect and send a 'FIN+' or 'FIN-' message to peer */ |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 2046 | skb = __skb_dequeue(&sk->sk_receive_queue); |
| 2047 | if (skb) { |
| 2048 | if (TIPC_SKB_CB(skb)->handle != NULL) { |
| 2049 | kfree_skb(skb); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2050 | goto restart; |
| 2051 | } |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 2052 | if (tipc_msg_reverse(skb, &dnode, TIPC_CONN_SHUTDOWN)) |
| 2053 | tipc_link_xmit_skb(skb, dnode, tsk->ref); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2054 | tipc_node_remove_conn(dnode, tsk->ref); |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2055 | } else { |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2056 | dnode = tsk_peer_node(tsk); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 2057 | skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE, |
Jon Paul Maloy | 80e44c2 | 2014-08-22 18:09:10 -0400 | [diff] [blame] | 2058 | TIPC_CONN_MSG, SHORT_H_SIZE, |
| 2059 | 0, dnode, tipc_own_addr, |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2060 | tsk_peer_port(tsk), |
| 2061 | tsk->ref, TIPC_CONN_SHUTDOWN); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 2062 | tipc_link_xmit_skb(skb, dnode, tsk->ref); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2063 | } |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2064 | tsk->connected = 0; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2065 | sock->state = SS_DISCONNECTING; |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2066 | tipc_node_remove_conn(dnode, tsk->ref); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2067 | /* fall through */ |
| 2068 | |
| 2069 | case SS_DISCONNECTING: |
| 2070 | |
Ying Xue | 7503115 | 2012-10-29 09:38:15 -0400 | [diff] [blame] | 2071 | /* Discard any unreceived messages */ |
Ying Xue | 57467e5 | 2013-01-20 23:30:08 +0100 | [diff] [blame] | 2072 | __skb_queue_purge(&sk->sk_receive_queue); |
Ying Xue | 7503115 | 2012-10-29 09:38:15 -0400 | [diff] [blame] | 2073 | |
| 2074 | /* Wake up anyone sleeping in poll */ |
| 2075 | sk->sk_state_change(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2076 | res = 0; |
| 2077 | break; |
| 2078 | |
| 2079 | default: |
| 2080 | res = -ENOTCONN; |
| 2081 | } |
| 2082 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2083 | release_sock(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2084 | return res; |
| 2085 | } |
| 2086 | |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 2087 | static void tipc_sk_timeout(unsigned long ref) |
| 2088 | { |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 2089 | struct tipc_sock *tsk; |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 2090 | struct sock *sk; |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 2091 | struct sk_buff *skb = NULL; |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 2092 | u32 peer_port, peer_node; |
| 2093 | |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 2094 | tsk = tipc_sk_get(ref); |
Jon Paul Maloy | 9b50fd0 | 2014-08-22 18:09:15 -0400 | [diff] [blame] | 2095 | if (!tsk) |
Ying Xue | cc086fc | 2014-08-28 10:02:41 +0800 | [diff] [blame] | 2096 | return; |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 2097 | |
Ying Xue | cc086fc | 2014-08-28 10:02:41 +0800 | [diff] [blame] | 2098 | sk = &tsk->sk; |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 2099 | bh_lock_sock(sk); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2100 | if (!tsk->connected) { |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 2101 | bh_unlock_sock(sk); |
| 2102 | goto exit; |
| 2103 | } |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2104 | peer_port = tsk_peer_port(tsk); |
| 2105 | peer_node = tsk_peer_node(tsk); |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 2106 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2107 | if (tsk->probing_state == TIPC_CONN_PROBING) { |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 2108 | /* Previous probe not answered -> self abort */ |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 2109 | skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE, TIPC_CONN_MSG, |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 2110 | SHORT_H_SIZE, 0, tipc_own_addr, |
| 2111 | peer_node, ref, peer_port, |
| 2112 | TIPC_ERR_NO_PORT); |
| 2113 | } else { |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 2114 | skb = tipc_msg_create(CONN_MANAGER, CONN_PROBE, INT_H_SIZE, |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 2115 | 0, peer_node, tipc_own_addr, |
| 2116 | peer_port, ref, TIPC_OK); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2117 | tsk->probing_state = TIPC_CONN_PROBING; |
| 2118 | k_start_timer(&tsk->timer, tsk->probing_interval); |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 2119 | } |
| 2120 | bh_unlock_sock(sk); |
Ying Xue | a6ca109 | 2014-11-26 11:41:55 +0800 | [diff] [blame] | 2121 | if (skb) |
| 2122 | tipc_link_xmit_skb(skb, peer_node, ref); |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 2123 | exit: |
| 2124 | tipc_sk_put(tsk); |
Jon Paul Maloy | 5728901 | 2014-08-22 18:09:09 -0400 | [diff] [blame] | 2125 | } |
| 2126 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2127 | static int tipc_sk_publish(struct tipc_sock *tsk, uint scope, |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 2128 | struct tipc_name_seq const *seq) |
| 2129 | { |
| 2130 | struct publication *publ; |
| 2131 | u32 key; |
| 2132 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2133 | if (tsk->connected) |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 2134 | return -EINVAL; |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2135 | key = tsk->ref + tsk->pub_count + 1; |
| 2136 | if (key == tsk->ref) |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 2137 | return -EADDRINUSE; |
| 2138 | |
| 2139 | publ = tipc_nametbl_publish(seq->type, seq->lower, seq->upper, |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2140 | scope, tsk->ref, key); |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 2141 | if (unlikely(!publ)) |
| 2142 | return -EINVAL; |
| 2143 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2144 | list_add(&publ->pport_list, &tsk->publications); |
| 2145 | tsk->pub_count++; |
| 2146 | tsk->published = 1; |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 2147 | return 0; |
| 2148 | } |
| 2149 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2150 | static int tipc_sk_withdraw(struct tipc_sock *tsk, uint scope, |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 2151 | struct tipc_name_seq const *seq) |
| 2152 | { |
| 2153 | struct publication *publ; |
| 2154 | struct publication *safe; |
| 2155 | int rc = -EINVAL; |
| 2156 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2157 | list_for_each_entry_safe(publ, safe, &tsk->publications, pport_list) { |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 2158 | if (seq) { |
| 2159 | if (publ->scope != scope) |
| 2160 | continue; |
| 2161 | if (publ->type != seq->type) |
| 2162 | continue; |
| 2163 | if (publ->lower != seq->lower) |
| 2164 | continue; |
| 2165 | if (publ->upper != seq->upper) |
| 2166 | break; |
| 2167 | tipc_nametbl_withdraw(publ->type, publ->lower, |
| 2168 | publ->ref, publ->key); |
| 2169 | rc = 0; |
| 2170 | break; |
| 2171 | } |
| 2172 | tipc_nametbl_withdraw(publ->type, publ->lower, |
| 2173 | publ->ref, publ->key); |
| 2174 | rc = 0; |
| 2175 | } |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2176 | if (list_empty(&tsk->publications)) |
| 2177 | tsk->published = 0; |
Jon Paul Maloy | 0fc87aa | 2014-08-22 18:09:17 -0400 | [diff] [blame] | 2178 | return rc; |
| 2179 | } |
| 2180 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2181 | static int tipc_sk_show(struct tipc_sock *tsk, char *buf, |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2182 | int len, int full_id) |
| 2183 | { |
| 2184 | struct publication *publ; |
| 2185 | int ret; |
| 2186 | |
| 2187 | if (full_id) |
| 2188 | ret = tipc_snprintf(buf, len, "<%u.%u.%u:%u>:", |
| 2189 | tipc_zone(tipc_own_addr), |
| 2190 | tipc_cluster(tipc_own_addr), |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2191 | tipc_node(tipc_own_addr), tsk->ref); |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2192 | else |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2193 | ret = tipc_snprintf(buf, len, "%-10u:", tsk->ref); |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2194 | |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2195 | if (tsk->connected) { |
| 2196 | u32 dport = tsk_peer_port(tsk); |
| 2197 | u32 destnode = tsk_peer_node(tsk); |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2198 | |
| 2199 | ret += tipc_snprintf(buf + ret, len - ret, |
| 2200 | " connected to <%u.%u.%u:%u>", |
| 2201 | tipc_zone(destnode), |
| 2202 | tipc_cluster(destnode), |
| 2203 | tipc_node(destnode), dport); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2204 | if (tsk->conn_type != 0) |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2205 | ret += tipc_snprintf(buf + ret, len - ret, |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2206 | " via {%u,%u}", tsk->conn_type, |
| 2207 | tsk->conn_instance); |
| 2208 | } else if (tsk->published) { |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2209 | ret += tipc_snprintf(buf + ret, len - ret, " bound to"); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2210 | list_for_each_entry(publ, &tsk->publications, pport_list) { |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2211 | if (publ->lower == publ->upper) |
| 2212 | ret += tipc_snprintf(buf + ret, len - ret, |
| 2213 | " {%u,%u}", publ->type, |
| 2214 | publ->lower); |
| 2215 | else |
| 2216 | ret += tipc_snprintf(buf + ret, len - ret, |
| 2217 | " {%u,%u,%u}", publ->type, |
| 2218 | publ->lower, publ->upper); |
| 2219 | } |
| 2220 | } |
| 2221 | ret += tipc_snprintf(buf + ret, len - ret, "\n"); |
| 2222 | return ret; |
| 2223 | } |
| 2224 | |
| 2225 | struct sk_buff *tipc_sk_socks_show(void) |
| 2226 | { |
| 2227 | struct sk_buff *buf; |
| 2228 | struct tlv_desc *rep_tlv; |
| 2229 | char *pb; |
| 2230 | int pb_len; |
| 2231 | struct tipc_sock *tsk; |
| 2232 | int str_len = 0; |
| 2233 | u32 ref = 0; |
| 2234 | |
| 2235 | buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN)); |
| 2236 | if (!buf) |
| 2237 | return NULL; |
| 2238 | rep_tlv = (struct tlv_desc *)buf->data; |
| 2239 | pb = TLV_DATA(rep_tlv); |
| 2240 | pb_len = ULTRA_STRING_MAX_LEN; |
| 2241 | |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 2242 | tsk = tipc_sk_get_next(&ref); |
| 2243 | for (; tsk; tsk = tipc_sk_get_next(&ref)) { |
| 2244 | lock_sock(&tsk->sk); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2245 | str_len += tipc_sk_show(tsk, pb + str_len, |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2246 | pb_len - str_len, 0); |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 2247 | release_sock(&tsk->sk); |
| 2248 | tipc_sk_put(tsk); |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2249 | } |
| 2250 | str_len += 1; /* for "\0" */ |
| 2251 | skb_put(buf, TLV_SPACE(str_len)); |
| 2252 | TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len); |
| 2253 | |
| 2254 | return buf; |
| 2255 | } |
| 2256 | |
| 2257 | /* tipc_sk_reinit: set non-zero address in all existing sockets |
| 2258 | * when we go from standalone to network mode. |
| 2259 | */ |
| 2260 | void tipc_sk_reinit(void) |
| 2261 | { |
| 2262 | struct tipc_msg *msg; |
| 2263 | u32 ref = 0; |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 2264 | struct tipc_sock *tsk = tipc_sk_get_next(&ref); |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2265 | |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 2266 | for (; tsk; tsk = tipc_sk_get_next(&ref)) { |
| 2267 | lock_sock(&tsk->sk); |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2268 | msg = &tsk->phdr; |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2269 | msg_set_prevnode(msg, tipc_own_addr); |
| 2270 | msg_set_orignode(msg, tipc_own_addr); |
Jon Paul Maloy | 6c9808c | 2014-08-22 18:09:16 -0400 | [diff] [blame] | 2271 | release_sock(&tsk->sk); |
| 2272 | tipc_sk_put(tsk); |
Jon Paul Maloy | 5a9ee0be | 2014-08-22 18:09:14 -0400 | [diff] [blame] | 2273 | } |
| 2274 | } |
| 2275 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2276 | /** |
Jon Paul Maloy | 808d90f | 2014-08-22 18:09:19 -0400 | [diff] [blame] | 2277 | * struct reference - TIPC socket reference entry |
| 2278 | * @tsk: pointer to socket associated with reference entry |
| 2279 | * @ref: reference value for socket (combines instance & array index info) |
| 2280 | */ |
| 2281 | struct reference { |
| 2282 | struct tipc_sock *tsk; |
| 2283 | u32 ref; |
| 2284 | }; |
| 2285 | |
| 2286 | /** |
| 2287 | * struct tipc_ref_table - table of TIPC socket reference entries |
| 2288 | * @entries: pointer to array of reference entries |
| 2289 | * @capacity: array index of first unusable entry |
| 2290 | * @init_point: array index of first uninitialized entry |
| 2291 | * @first_free: array index of first unused socket reference entry |
| 2292 | * @last_free: array index of last unused socket reference entry |
| 2293 | * @index_mask: bitmask for array index portion of reference values |
| 2294 | * @start_mask: initial value for instance value portion of reference values |
| 2295 | */ |
| 2296 | struct ref_table { |
| 2297 | struct reference *entries; |
| 2298 | u32 capacity; |
| 2299 | u32 init_point; |
| 2300 | u32 first_free; |
| 2301 | u32 last_free; |
| 2302 | u32 index_mask; |
| 2303 | u32 start_mask; |
| 2304 | }; |
| 2305 | |
| 2306 | /* Socket reference table consists of 2**N entries. |
| 2307 | * |
| 2308 | * State Socket ptr Reference |
| 2309 | * ----- ---------- --------- |
| 2310 | * In use non-NULL XXXX|own index |
| 2311 | * (XXXX changes each time entry is acquired) |
| 2312 | * Free NULL YYYY|next free index |
| 2313 | * (YYYY is one more than last used XXXX) |
| 2314 | * Uninitialized NULL 0 |
| 2315 | * |
| 2316 | * Entry 0 is not used; this allows index 0 to denote the end of the free list. |
| 2317 | * |
| 2318 | * Note that a reference value of 0 does not necessarily indicate that an |
| 2319 | * entry is uninitialized, since the last entry in the free list could also |
| 2320 | * have a reference value of 0 (although this is unlikely). |
| 2321 | */ |
| 2322 | |
| 2323 | static struct ref_table tipc_ref_table; |
| 2324 | |
| 2325 | static DEFINE_RWLOCK(ref_table_lock); |
| 2326 | |
| 2327 | /** |
| 2328 | * tipc_ref_table_init - create reference table for sockets |
| 2329 | */ |
| 2330 | int tipc_sk_ref_table_init(u32 req_sz, u32 start) |
| 2331 | { |
| 2332 | struct reference *table; |
| 2333 | u32 actual_sz; |
| 2334 | |
| 2335 | /* account for unused entry, then round up size to a power of 2 */ |
| 2336 | |
| 2337 | req_sz++; |
| 2338 | for (actual_sz = 16; actual_sz < req_sz; actual_sz <<= 1) { |
| 2339 | /* do nothing */ |
| 2340 | }; |
| 2341 | |
| 2342 | /* allocate table & mark all entries as uninitialized */ |
| 2343 | table = vzalloc(actual_sz * sizeof(struct reference)); |
| 2344 | if (table == NULL) |
| 2345 | return -ENOMEM; |
| 2346 | |
| 2347 | tipc_ref_table.entries = table; |
| 2348 | tipc_ref_table.capacity = req_sz; |
| 2349 | tipc_ref_table.init_point = 1; |
| 2350 | tipc_ref_table.first_free = 0; |
| 2351 | tipc_ref_table.last_free = 0; |
| 2352 | tipc_ref_table.index_mask = actual_sz - 1; |
| 2353 | tipc_ref_table.start_mask = start & ~tipc_ref_table.index_mask; |
| 2354 | |
| 2355 | return 0; |
| 2356 | } |
| 2357 | |
| 2358 | /** |
| 2359 | * tipc_ref_table_stop - destroy reference table for sockets |
| 2360 | */ |
| 2361 | void tipc_sk_ref_table_stop(void) |
| 2362 | { |
| 2363 | if (!tipc_ref_table.entries) |
| 2364 | return; |
| 2365 | vfree(tipc_ref_table.entries); |
| 2366 | tipc_ref_table.entries = NULL; |
| 2367 | } |
| 2368 | |
| 2369 | /* tipc_ref_acquire - create reference to a socket |
| 2370 | * |
| 2371 | * Register an socket pointer in the reference table. |
| 2372 | * Returns a unique reference value that is used from then on to retrieve the |
| 2373 | * socket pointer, or to determine if the socket has been deregistered. |
| 2374 | */ |
| 2375 | u32 tipc_sk_ref_acquire(struct tipc_sock *tsk) |
| 2376 | { |
| 2377 | u32 index; |
| 2378 | u32 index_mask; |
| 2379 | u32 next_plus_upper; |
| 2380 | u32 ref = 0; |
| 2381 | struct reference *entry; |
| 2382 | |
| 2383 | if (unlikely(!tsk)) { |
| 2384 | pr_err("Attempt to acquire ref. to non-existent obj\n"); |
| 2385 | return 0; |
| 2386 | } |
| 2387 | if (unlikely(!tipc_ref_table.entries)) { |
| 2388 | pr_err("Ref. table not found in acquisition attempt\n"); |
| 2389 | return 0; |
| 2390 | } |
| 2391 | |
| 2392 | /* Take a free entry, if available; otherwise initialize a new one */ |
| 2393 | write_lock_bh(&ref_table_lock); |
| 2394 | index = tipc_ref_table.first_free; |
| 2395 | entry = &tipc_ref_table.entries[index]; |
| 2396 | |
| 2397 | if (likely(index)) { |
| 2398 | index = tipc_ref_table.first_free; |
| 2399 | entry = &tipc_ref_table.entries[index]; |
| 2400 | index_mask = tipc_ref_table.index_mask; |
| 2401 | next_plus_upper = entry->ref; |
| 2402 | tipc_ref_table.first_free = next_plus_upper & index_mask; |
| 2403 | ref = (next_plus_upper & ~index_mask) + index; |
| 2404 | entry->tsk = tsk; |
| 2405 | } else if (tipc_ref_table.init_point < tipc_ref_table.capacity) { |
| 2406 | index = tipc_ref_table.init_point++; |
| 2407 | entry = &tipc_ref_table.entries[index]; |
| 2408 | ref = tipc_ref_table.start_mask + index; |
| 2409 | } |
| 2410 | |
| 2411 | if (ref) { |
| 2412 | entry->ref = ref; |
| 2413 | entry->tsk = tsk; |
| 2414 | } |
| 2415 | write_unlock_bh(&ref_table_lock); |
| 2416 | return ref; |
| 2417 | } |
| 2418 | |
| 2419 | /* tipc_sk_ref_discard - invalidate reference to an socket |
| 2420 | * |
| 2421 | * Disallow future references to an socket and free up the entry for re-use. |
| 2422 | */ |
| 2423 | void tipc_sk_ref_discard(u32 ref) |
| 2424 | { |
| 2425 | struct reference *entry; |
| 2426 | u32 index; |
| 2427 | u32 index_mask; |
| 2428 | |
| 2429 | if (unlikely(!tipc_ref_table.entries)) { |
| 2430 | pr_err("Ref. table not found during discard attempt\n"); |
| 2431 | return; |
| 2432 | } |
| 2433 | |
| 2434 | index_mask = tipc_ref_table.index_mask; |
| 2435 | index = ref & index_mask; |
| 2436 | entry = &tipc_ref_table.entries[index]; |
| 2437 | |
| 2438 | write_lock_bh(&ref_table_lock); |
| 2439 | |
| 2440 | if (unlikely(!entry->tsk)) { |
| 2441 | pr_err("Attempt to discard ref. to non-existent socket\n"); |
| 2442 | goto exit; |
| 2443 | } |
| 2444 | if (unlikely(entry->ref != ref)) { |
| 2445 | pr_err("Attempt to discard non-existent reference\n"); |
| 2446 | goto exit; |
| 2447 | } |
| 2448 | |
| 2449 | /* Mark entry as unused; increment instance part of entry's |
| 2450 | * reference to invalidate any subsequent references |
| 2451 | */ |
| 2452 | |
| 2453 | entry->tsk = NULL; |
| 2454 | entry->ref = (ref & ~index_mask) + (index_mask + 1); |
| 2455 | |
| 2456 | /* Append entry to free entry list */ |
| 2457 | if (unlikely(tipc_ref_table.first_free == 0)) |
| 2458 | tipc_ref_table.first_free = index; |
| 2459 | else |
| 2460 | tipc_ref_table.entries[tipc_ref_table.last_free].ref |= index; |
| 2461 | tipc_ref_table.last_free = index; |
| 2462 | exit: |
| 2463 | write_unlock_bh(&ref_table_lock); |
| 2464 | } |
| 2465 | |
| 2466 | /* tipc_sk_get - find referenced socket and return pointer to it |
| 2467 | */ |
| 2468 | struct tipc_sock *tipc_sk_get(u32 ref) |
| 2469 | { |
| 2470 | struct reference *entry; |
| 2471 | struct tipc_sock *tsk; |
| 2472 | |
| 2473 | if (unlikely(!tipc_ref_table.entries)) |
| 2474 | return NULL; |
| 2475 | read_lock_bh(&ref_table_lock); |
| 2476 | entry = &tipc_ref_table.entries[ref & tipc_ref_table.index_mask]; |
| 2477 | tsk = entry->tsk; |
| 2478 | if (likely(tsk && (entry->ref == ref))) |
| 2479 | sock_hold(&tsk->sk); |
| 2480 | else |
| 2481 | tsk = NULL; |
| 2482 | read_unlock_bh(&ref_table_lock); |
| 2483 | return tsk; |
| 2484 | } |
| 2485 | |
| 2486 | /* tipc_sk_get_next - lock & return next socket after referenced one |
| 2487 | */ |
| 2488 | struct tipc_sock *tipc_sk_get_next(u32 *ref) |
| 2489 | { |
| 2490 | struct reference *entry; |
| 2491 | struct tipc_sock *tsk = NULL; |
| 2492 | uint index = *ref & tipc_ref_table.index_mask; |
| 2493 | |
| 2494 | read_lock_bh(&ref_table_lock); |
| 2495 | while (++index < tipc_ref_table.capacity) { |
| 2496 | entry = &tipc_ref_table.entries[index]; |
| 2497 | if (!entry->tsk) |
| 2498 | continue; |
| 2499 | tsk = entry->tsk; |
| 2500 | sock_hold(&tsk->sk); |
| 2501 | *ref = entry->ref; |
| 2502 | break; |
| 2503 | } |
| 2504 | read_unlock_bh(&ref_table_lock); |
| 2505 | return tsk; |
| 2506 | } |
| 2507 | |
| 2508 | static void tipc_sk_put(struct tipc_sock *tsk) |
| 2509 | { |
| 2510 | sock_put(&tsk->sk); |
| 2511 | } |
| 2512 | |
| 2513 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2514 | * tipc_setsockopt - set socket option |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2515 | * @sock: socket structure |
| 2516 | * @lvl: option level |
| 2517 | * @opt: option identifier |
| 2518 | * @ov: pointer to new option value |
| 2519 | * @ol: length of option value |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2520 | * |
| 2521 | * For stream sockets only, accepts and ignores all IPPROTO_TCP options |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2522 | * (to ease compatibility). |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2523 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2524 | * Returns 0 on success, errno otherwise |
| 2525 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2526 | static int tipc_setsockopt(struct socket *sock, int lvl, int opt, |
| 2527 | char __user *ov, unsigned int ol) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2528 | { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2529 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 2530 | struct tipc_sock *tsk = tipc_sk(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2531 | u32 value; |
| 2532 | int res; |
| 2533 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2534 | if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM)) |
| 2535 | return 0; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2536 | if (lvl != SOL_TIPC) |
| 2537 | return -ENOPROTOOPT; |
| 2538 | if (ol < sizeof(value)) |
| 2539 | return -EINVAL; |
Allan Stephens | 2db9983 | 2010-12-31 18:59:33 +0000 | [diff] [blame] | 2540 | res = get_user(value, (u32 __user *)ov); |
| 2541 | if (res) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2542 | return res; |
| 2543 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2544 | lock_sock(sk); |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2545 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2546 | switch (opt) { |
| 2547 | case TIPC_IMPORTANCE: |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2548 | res = tsk_set_importance(tsk, value); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2549 | break; |
| 2550 | case TIPC_SRC_DROPPABLE: |
| 2551 | if (sock->type != SOCK_STREAM) |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2552 | tsk_set_unreliable(tsk, value); |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2553 | else |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2554 | res = -ENOPROTOOPT; |
| 2555 | break; |
| 2556 | case TIPC_DEST_DROPPABLE: |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2557 | tsk_set_unreturnable(tsk, value); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2558 | break; |
| 2559 | case TIPC_CONN_TIMEOUT: |
Allan Stephens | a0f40f0 | 2011-05-26 13:44:34 -0400 | [diff] [blame] | 2560 | tipc_sk(sk)->conn_timeout = value; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2561 | /* no need to set "res", since already 0 at this point */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2562 | break; |
| 2563 | default: |
| 2564 | res = -EINVAL; |
| 2565 | } |
| 2566 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2567 | release_sock(sk); |
| 2568 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2569 | return res; |
| 2570 | } |
| 2571 | |
| 2572 | /** |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2573 | * tipc_getsockopt - get socket option |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2574 | * @sock: socket structure |
| 2575 | * @lvl: option level |
| 2576 | * @opt: option identifier |
| 2577 | * @ov: receptacle for option value |
| 2578 | * @ol: receptacle for length of option value |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2579 | * |
| 2580 | * For stream sockets only, returns 0 length result for all IPPROTO_TCP options |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2581 | * (to ease compatibility). |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2582 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2583 | * Returns 0 on success, errno otherwise |
| 2584 | */ |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2585 | static int tipc_getsockopt(struct socket *sock, int lvl, int opt, |
| 2586 | char __user *ov, int __user *ol) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2587 | { |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2588 | struct sock *sk = sock->sk; |
Jon Paul Maloy | 58ed944 | 2014-03-12 11:31:12 -0400 | [diff] [blame] | 2589 | struct tipc_sock *tsk = tipc_sk(sk); |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2590 | int len; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2591 | u32 value; |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2592 | int res; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2593 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2594 | if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM)) |
| 2595 | return put_user(0, ol); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2596 | if (lvl != SOL_TIPC) |
| 2597 | return -ENOPROTOOPT; |
Allan Stephens | 2db9983 | 2010-12-31 18:59:33 +0000 | [diff] [blame] | 2598 | res = get_user(len, ol); |
| 2599 | if (res) |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2600 | return res; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2601 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2602 | lock_sock(sk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2603 | |
| 2604 | switch (opt) { |
| 2605 | case TIPC_IMPORTANCE: |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2606 | value = tsk_importance(tsk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2607 | break; |
| 2608 | case TIPC_SRC_DROPPABLE: |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2609 | value = tsk_unreliable(tsk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2610 | break; |
| 2611 | case TIPC_DEST_DROPPABLE: |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2612 | value = tsk_unreturnable(tsk); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2613 | break; |
| 2614 | case TIPC_CONN_TIMEOUT: |
Jon Paul Maloy | 301bae5 | 2014-08-22 18:09:20 -0400 | [diff] [blame] | 2615 | value = tsk->conn_timeout; |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2616 | /* no need to set "res", since already 0 at this point */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2617 | break; |
Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2618 | case TIPC_NODE_RECVQ_DEPTH: |
Ying Xue | 9da3d47 | 2012-11-27 06:15:27 -0500 | [diff] [blame] | 2619 | value = 0; /* was tipc_queue_size, now obsolete */ |
oscar.medina@motorola.com | 6650613 | 2009-06-30 03:25:39 +0000 | [diff] [blame] | 2620 | break; |
Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2621 | case TIPC_SOCK_RECVQ_DEPTH: |
oscar.medina@motorola.com | 6650613 | 2009-06-30 03:25:39 +0000 | [diff] [blame] | 2622 | value = skb_queue_len(&sk->sk_receive_queue); |
| 2623 | break; |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2624 | default: |
| 2625 | res = -EINVAL; |
| 2626 | } |
| 2627 | |
Allan Stephens | 0c3141e | 2008-04-15 00:22:02 -0700 | [diff] [blame] | 2628 | release_sock(sk); |
| 2629 | |
Paul Gortmaker | 25860c3 | 2010-12-31 18:59:31 +0000 | [diff] [blame] | 2630 | if (res) |
| 2631 | return res; /* "get" failed */ |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2632 | |
Paul Gortmaker | 25860c3 | 2010-12-31 18:59:31 +0000 | [diff] [blame] | 2633 | if (len < sizeof(value)) |
| 2634 | return -EINVAL; |
| 2635 | |
| 2636 | if (copy_to_user(ov, &value, sizeof(value))) |
| 2637 | return -EFAULT; |
| 2638 | |
| 2639 | return put_user(sizeof(value), ol); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2640 | } |
| 2641 | |
Wei Yongjun | 52f50ce | 2014-07-20 13:14:28 +0800 | [diff] [blame] | 2642 | static int tipc_ioctl(struct socket *sk, unsigned int cmd, unsigned long arg) |
Erik Hugne | 78acb1f | 2014-04-24 16:26:47 +0200 | [diff] [blame] | 2643 | { |
| 2644 | struct tipc_sioc_ln_req lnr; |
| 2645 | void __user *argp = (void __user *)arg; |
| 2646 | |
| 2647 | switch (cmd) { |
| 2648 | case SIOCGETLINKNAME: |
| 2649 | if (copy_from_user(&lnr, argp, sizeof(lnr))) |
| 2650 | return -EFAULT; |
Ying Xue | 7b8613e | 2014-10-20 14:44:25 +0800 | [diff] [blame] | 2651 | if (!tipc_node_get_linkname(lnr.bearer_id & 0xffff, lnr.peer, |
Erik Hugne | 78acb1f | 2014-04-24 16:26:47 +0200 | [diff] [blame] | 2652 | lnr.linkname, TIPC_MAX_LINK_NAME)) { |
| 2653 | if (copy_to_user(argp, &lnr, sizeof(lnr))) |
| 2654 | return -EFAULT; |
| 2655 | return 0; |
| 2656 | } |
| 2657 | return -EADDRNOTAVAIL; |
Erik Hugne | 78acb1f | 2014-04-24 16:26:47 +0200 | [diff] [blame] | 2658 | default: |
| 2659 | return -ENOIOCTLCMD; |
| 2660 | } |
| 2661 | } |
| 2662 | |
Ben Hutchings | ae86b9e | 2012-07-10 10:55:35 +0000 | [diff] [blame] | 2663 | /* Protocol switches for the various types of TIPC sockets */ |
| 2664 | |
Florian Westphal | bca65ea | 2008-02-07 18:18:01 -0800 | [diff] [blame] | 2665 | static const struct proto_ops msg_ops = { |
Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2666 | .owner = THIS_MODULE, |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2667 | .family = AF_TIPC, |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2668 | .release = tipc_release, |
| 2669 | .bind = tipc_bind, |
| 2670 | .connect = tipc_connect, |
Allan Stephens | 5eee6a6 | 2007-06-10 17:24:55 -0700 | [diff] [blame] | 2671 | .socketpair = sock_no_socketpair, |
Ying Xue | 245f3d3 | 2011-07-06 06:01:13 -0400 | [diff] [blame] | 2672 | .accept = sock_no_accept, |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2673 | .getname = tipc_getname, |
| 2674 | .poll = tipc_poll, |
Erik Hugne | 78acb1f | 2014-04-24 16:26:47 +0200 | [diff] [blame] | 2675 | .ioctl = tipc_ioctl, |
Ying Xue | 245f3d3 | 2011-07-06 06:01:13 -0400 | [diff] [blame] | 2676 | .listen = sock_no_listen, |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2677 | .shutdown = tipc_shutdown, |
| 2678 | .setsockopt = tipc_setsockopt, |
| 2679 | .getsockopt = tipc_getsockopt, |
| 2680 | .sendmsg = tipc_sendmsg, |
| 2681 | .recvmsg = tipc_recvmsg, |
YOSHIFUJI Hideaki | 8238745 | 2007-07-19 10:44:56 +0900 | [diff] [blame] | 2682 | .mmap = sock_no_mmap, |
| 2683 | .sendpage = sock_no_sendpage |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2684 | }; |
| 2685 | |
Florian Westphal | bca65ea | 2008-02-07 18:18:01 -0800 | [diff] [blame] | 2686 | static const struct proto_ops packet_ops = { |
Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2687 | .owner = THIS_MODULE, |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2688 | .family = AF_TIPC, |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2689 | .release = tipc_release, |
| 2690 | .bind = tipc_bind, |
| 2691 | .connect = tipc_connect, |
Allan Stephens | 5eee6a6 | 2007-06-10 17:24:55 -0700 | [diff] [blame] | 2692 | .socketpair = sock_no_socketpair, |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2693 | .accept = tipc_accept, |
| 2694 | .getname = tipc_getname, |
| 2695 | .poll = tipc_poll, |
Erik Hugne | 78acb1f | 2014-04-24 16:26:47 +0200 | [diff] [blame] | 2696 | .ioctl = tipc_ioctl, |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2697 | .listen = tipc_listen, |
| 2698 | .shutdown = tipc_shutdown, |
| 2699 | .setsockopt = tipc_setsockopt, |
| 2700 | .getsockopt = tipc_getsockopt, |
| 2701 | .sendmsg = tipc_send_packet, |
| 2702 | .recvmsg = tipc_recvmsg, |
YOSHIFUJI Hideaki | 8238745 | 2007-07-19 10:44:56 +0900 | [diff] [blame] | 2703 | .mmap = sock_no_mmap, |
| 2704 | .sendpage = sock_no_sendpage |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2705 | }; |
| 2706 | |
Florian Westphal | bca65ea | 2008-02-07 18:18:01 -0800 | [diff] [blame] | 2707 | static const struct proto_ops stream_ops = { |
Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2708 | .owner = THIS_MODULE, |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2709 | .family = AF_TIPC, |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2710 | .release = tipc_release, |
| 2711 | .bind = tipc_bind, |
| 2712 | .connect = tipc_connect, |
Allan Stephens | 5eee6a6 | 2007-06-10 17:24:55 -0700 | [diff] [blame] | 2713 | .socketpair = sock_no_socketpair, |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2714 | .accept = tipc_accept, |
| 2715 | .getname = tipc_getname, |
| 2716 | .poll = tipc_poll, |
Erik Hugne | 78acb1f | 2014-04-24 16:26:47 +0200 | [diff] [blame] | 2717 | .ioctl = tipc_ioctl, |
Ying Xue | 247f0f3 | 2014-02-18 16:06:46 +0800 | [diff] [blame] | 2718 | .listen = tipc_listen, |
| 2719 | .shutdown = tipc_shutdown, |
| 2720 | .setsockopt = tipc_setsockopt, |
| 2721 | .getsockopt = tipc_getsockopt, |
| 2722 | .sendmsg = tipc_send_stream, |
| 2723 | .recvmsg = tipc_recv_stream, |
YOSHIFUJI Hideaki | 8238745 | 2007-07-19 10:44:56 +0900 | [diff] [blame] | 2724 | .mmap = sock_no_mmap, |
| 2725 | .sendpage = sock_no_sendpage |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2726 | }; |
| 2727 | |
Florian Westphal | bca65ea | 2008-02-07 18:18:01 -0800 | [diff] [blame] | 2728 | static const struct net_proto_family tipc_family_ops = { |
Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2729 | .owner = THIS_MODULE, |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2730 | .family = AF_TIPC, |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 2731 | .create = tipc_sk_create |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2732 | }; |
| 2733 | |
| 2734 | static struct proto tipc_proto = { |
| 2735 | .name = "TIPC", |
| 2736 | .owner = THIS_MODULE, |
Ying Xue | cc79dd1 | 2013-06-17 10:54:37 -0400 | [diff] [blame] | 2737 | .obj_size = sizeof(struct tipc_sock), |
| 2738 | .sysctl_rmem = sysctl_tipc_rmem |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2739 | }; |
| 2740 | |
Ying Xue | c5fa7b3 | 2013-06-17 10:54:39 -0400 | [diff] [blame] | 2741 | static struct proto tipc_proto_kern = { |
| 2742 | .name = "TIPC", |
| 2743 | .obj_size = sizeof(struct tipc_sock), |
| 2744 | .sysctl_rmem = sysctl_tipc_rmem |
| 2745 | }; |
| 2746 | |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2747 | /** |
Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2748 | * tipc_socket_init - initialize TIPC socket interface |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2749 | * |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2750 | * Returns 0 on success, errno otherwise |
| 2751 | */ |
Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2752 | int tipc_socket_init(void) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2753 | { |
| 2754 | int res; |
| 2755 | |
YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2756 | res = proto_register(&tipc_proto, 1); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2757 | if (res) { |
Erik Hugne | 2cf8aa1 | 2012-06-29 00:16:37 -0400 | [diff] [blame] | 2758 | pr_err("Failed to register TIPC protocol type\n"); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2759 | goto out; |
| 2760 | } |
| 2761 | |
| 2762 | res = sock_register(&tipc_family_ops); |
| 2763 | if (res) { |
Erik Hugne | 2cf8aa1 | 2012-06-29 00:16:37 -0400 | [diff] [blame] | 2764 | pr_err("Failed to register TIPC socket type\n"); |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2765 | proto_unregister(&tipc_proto); |
| 2766 | goto out; |
| 2767 | } |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2768 | out: |
| 2769 | return res; |
| 2770 | } |
| 2771 | |
| 2772 | /** |
Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2773 | * tipc_socket_stop - stop TIPC socket interface |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2774 | */ |
Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2775 | void tipc_socket_stop(void) |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2776 | { |
Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2777 | sock_unregister(tipc_family_ops.family); |
| 2778 | proto_unregister(&tipc_proto); |
| 2779 | } |
Richard Alpe | 34b78a12 | 2014-11-20 10:29:10 +0100 | [diff] [blame] | 2780 | |
| 2781 | /* Caller should hold socket lock for the passed tipc socket. */ |
Richard Alpe | d818280 | 2014-11-24 11:10:29 +0100 | [diff] [blame] | 2782 | static int __tipc_nl_add_sk_con(struct sk_buff *skb, struct tipc_sock *tsk) |
Richard Alpe | 34b78a12 | 2014-11-20 10:29:10 +0100 | [diff] [blame] | 2783 | { |
| 2784 | u32 peer_node; |
| 2785 | u32 peer_port; |
| 2786 | struct nlattr *nest; |
| 2787 | |
| 2788 | peer_node = tsk_peer_node(tsk); |
| 2789 | peer_port = tsk_peer_port(tsk); |
| 2790 | |
| 2791 | nest = nla_nest_start(skb, TIPC_NLA_SOCK_CON); |
| 2792 | |
| 2793 | if (nla_put_u32(skb, TIPC_NLA_CON_NODE, peer_node)) |
| 2794 | goto msg_full; |
| 2795 | if (nla_put_u32(skb, TIPC_NLA_CON_SOCK, peer_port)) |
| 2796 | goto msg_full; |
| 2797 | |
| 2798 | if (tsk->conn_type != 0) { |
| 2799 | if (nla_put_flag(skb, TIPC_NLA_CON_FLAG)) |
| 2800 | goto msg_full; |
| 2801 | if (nla_put_u32(skb, TIPC_NLA_CON_TYPE, tsk->conn_type)) |
| 2802 | goto msg_full; |
| 2803 | if (nla_put_u32(skb, TIPC_NLA_CON_INST, tsk->conn_instance)) |
| 2804 | goto msg_full; |
| 2805 | } |
| 2806 | nla_nest_end(skb, nest); |
| 2807 | |
| 2808 | return 0; |
| 2809 | |
| 2810 | msg_full: |
| 2811 | nla_nest_cancel(skb, nest); |
| 2812 | |
| 2813 | return -EMSGSIZE; |
| 2814 | } |
| 2815 | |
| 2816 | /* Caller should hold socket lock for the passed tipc socket. */ |
Richard Alpe | d818280 | 2014-11-24 11:10:29 +0100 | [diff] [blame] | 2817 | static int __tipc_nl_add_sk(struct sk_buff *skb, struct netlink_callback *cb, |
| 2818 | struct tipc_sock *tsk) |
Richard Alpe | 34b78a12 | 2014-11-20 10:29:10 +0100 | [diff] [blame] | 2819 | { |
| 2820 | int err; |
| 2821 | void *hdr; |
| 2822 | struct nlattr *attrs; |
| 2823 | |
| 2824 | hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq, |
| 2825 | &tipc_genl_v2_family, NLM_F_MULTI, TIPC_NL_SOCK_GET); |
| 2826 | if (!hdr) |
| 2827 | goto msg_cancel; |
| 2828 | |
| 2829 | attrs = nla_nest_start(skb, TIPC_NLA_SOCK); |
| 2830 | if (!attrs) |
| 2831 | goto genlmsg_cancel; |
| 2832 | if (nla_put_u32(skb, TIPC_NLA_SOCK_REF, tsk->ref)) |
| 2833 | goto attr_msg_cancel; |
| 2834 | if (nla_put_u32(skb, TIPC_NLA_SOCK_ADDR, tipc_own_addr)) |
| 2835 | goto attr_msg_cancel; |
| 2836 | |
| 2837 | if (tsk->connected) { |
| 2838 | err = __tipc_nl_add_sk_con(skb, tsk); |
| 2839 | if (err) |
| 2840 | goto attr_msg_cancel; |
| 2841 | } else if (!list_empty(&tsk->publications)) { |
| 2842 | if (nla_put_flag(skb, TIPC_NLA_SOCK_HAS_PUBL)) |
| 2843 | goto attr_msg_cancel; |
| 2844 | } |
| 2845 | nla_nest_end(skb, attrs); |
| 2846 | genlmsg_end(skb, hdr); |
| 2847 | |
| 2848 | return 0; |
| 2849 | |
| 2850 | attr_msg_cancel: |
| 2851 | nla_nest_cancel(skb, attrs); |
| 2852 | genlmsg_cancel: |
| 2853 | genlmsg_cancel(skb, hdr); |
| 2854 | msg_cancel: |
| 2855 | return -EMSGSIZE; |
| 2856 | } |
| 2857 | |
| 2858 | int tipc_nl_sk_dump(struct sk_buff *skb, struct netlink_callback *cb) |
| 2859 | { |
| 2860 | int err; |
| 2861 | struct tipc_sock *tsk; |
| 2862 | u32 prev_ref = cb->args[0]; |
| 2863 | u32 ref = prev_ref; |
| 2864 | |
| 2865 | tsk = tipc_sk_get_next(&ref); |
| 2866 | for (; tsk; tsk = tipc_sk_get_next(&ref)) { |
| 2867 | lock_sock(&tsk->sk); |
| 2868 | err = __tipc_nl_add_sk(skb, cb, tsk); |
| 2869 | release_sock(&tsk->sk); |
| 2870 | tipc_sk_put(tsk); |
| 2871 | if (err) |
| 2872 | break; |
| 2873 | |
| 2874 | prev_ref = ref; |
| 2875 | } |
| 2876 | |
| 2877 | cb->args[0] = prev_ref; |
| 2878 | |
| 2879 | return skb->len; |
| 2880 | } |
Richard Alpe | 1a1a143 | 2014-11-20 10:29:11 +0100 | [diff] [blame] | 2881 | |
| 2882 | /* Caller should hold socket lock for the passed tipc socket. */ |
Richard Alpe | d818280 | 2014-11-24 11:10:29 +0100 | [diff] [blame] | 2883 | static int __tipc_nl_add_sk_publ(struct sk_buff *skb, |
| 2884 | struct netlink_callback *cb, |
| 2885 | struct publication *publ) |
Richard Alpe | 1a1a143 | 2014-11-20 10:29:11 +0100 | [diff] [blame] | 2886 | { |
| 2887 | void *hdr; |
| 2888 | struct nlattr *attrs; |
| 2889 | |
| 2890 | hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq, |
| 2891 | &tipc_genl_v2_family, NLM_F_MULTI, TIPC_NL_PUBL_GET); |
| 2892 | if (!hdr) |
| 2893 | goto msg_cancel; |
| 2894 | |
| 2895 | attrs = nla_nest_start(skb, TIPC_NLA_PUBL); |
| 2896 | if (!attrs) |
| 2897 | goto genlmsg_cancel; |
| 2898 | |
| 2899 | if (nla_put_u32(skb, TIPC_NLA_PUBL_KEY, publ->key)) |
| 2900 | goto attr_msg_cancel; |
| 2901 | if (nla_put_u32(skb, TIPC_NLA_PUBL_TYPE, publ->type)) |
| 2902 | goto attr_msg_cancel; |
| 2903 | if (nla_put_u32(skb, TIPC_NLA_PUBL_LOWER, publ->lower)) |
| 2904 | goto attr_msg_cancel; |
| 2905 | if (nla_put_u32(skb, TIPC_NLA_PUBL_UPPER, publ->upper)) |
| 2906 | goto attr_msg_cancel; |
| 2907 | |
| 2908 | nla_nest_end(skb, attrs); |
| 2909 | genlmsg_end(skb, hdr); |
| 2910 | |
| 2911 | return 0; |
| 2912 | |
| 2913 | attr_msg_cancel: |
| 2914 | nla_nest_cancel(skb, attrs); |
| 2915 | genlmsg_cancel: |
| 2916 | genlmsg_cancel(skb, hdr); |
| 2917 | msg_cancel: |
| 2918 | return -EMSGSIZE; |
| 2919 | } |
| 2920 | |
| 2921 | /* Caller should hold socket lock for the passed tipc socket. */ |
Richard Alpe | d818280 | 2014-11-24 11:10:29 +0100 | [diff] [blame] | 2922 | static int __tipc_nl_list_sk_publ(struct sk_buff *skb, |
| 2923 | struct netlink_callback *cb, |
| 2924 | struct tipc_sock *tsk, u32 *last_publ) |
Richard Alpe | 1a1a143 | 2014-11-20 10:29:11 +0100 | [diff] [blame] | 2925 | { |
| 2926 | int err; |
| 2927 | struct publication *p; |
| 2928 | |
| 2929 | if (*last_publ) { |
| 2930 | list_for_each_entry(p, &tsk->publications, pport_list) { |
| 2931 | if (p->key == *last_publ) |
| 2932 | break; |
| 2933 | } |
| 2934 | if (p->key != *last_publ) { |
| 2935 | /* We never set seq or call nl_dump_check_consistent() |
| 2936 | * this means that setting prev_seq here will cause the |
| 2937 | * consistence check to fail in the netlink callback |
| 2938 | * handler. Resulting in the last NLMSG_DONE message |
| 2939 | * having the NLM_F_DUMP_INTR flag set. |
| 2940 | */ |
| 2941 | cb->prev_seq = 1; |
| 2942 | *last_publ = 0; |
| 2943 | return -EPIPE; |
| 2944 | } |
| 2945 | } else { |
| 2946 | p = list_first_entry(&tsk->publications, struct publication, |
| 2947 | pport_list); |
| 2948 | } |
| 2949 | |
| 2950 | list_for_each_entry_from(p, &tsk->publications, pport_list) { |
| 2951 | err = __tipc_nl_add_sk_publ(skb, cb, p); |
| 2952 | if (err) { |
| 2953 | *last_publ = p->key; |
| 2954 | return err; |
| 2955 | } |
| 2956 | } |
| 2957 | *last_publ = 0; |
| 2958 | |
| 2959 | return 0; |
| 2960 | } |
| 2961 | |
| 2962 | int tipc_nl_publ_dump(struct sk_buff *skb, struct netlink_callback *cb) |
| 2963 | { |
| 2964 | int err; |
| 2965 | u32 tsk_ref = cb->args[0]; |
| 2966 | u32 last_publ = cb->args[1]; |
| 2967 | u32 done = cb->args[2]; |
| 2968 | struct tipc_sock *tsk; |
| 2969 | |
| 2970 | if (!tsk_ref) { |
| 2971 | struct nlattr **attrs; |
| 2972 | struct nlattr *sock[TIPC_NLA_SOCK_MAX + 1]; |
| 2973 | |
| 2974 | err = tipc_nlmsg_parse(cb->nlh, &attrs); |
| 2975 | if (err) |
| 2976 | return err; |
| 2977 | |
| 2978 | err = nla_parse_nested(sock, TIPC_NLA_SOCK_MAX, |
| 2979 | attrs[TIPC_NLA_SOCK], |
| 2980 | tipc_nl_sock_policy); |
| 2981 | if (err) |
| 2982 | return err; |
| 2983 | |
| 2984 | if (!sock[TIPC_NLA_SOCK_REF]) |
| 2985 | return -EINVAL; |
| 2986 | |
| 2987 | tsk_ref = nla_get_u32(sock[TIPC_NLA_SOCK_REF]); |
| 2988 | } |
| 2989 | |
| 2990 | if (done) |
| 2991 | return 0; |
| 2992 | |
| 2993 | tsk = tipc_sk_get(tsk_ref); |
| 2994 | if (!tsk) |
| 2995 | return -EINVAL; |
| 2996 | |
| 2997 | lock_sock(&tsk->sk); |
| 2998 | err = __tipc_nl_list_sk_publ(skb, cb, tsk, &last_publ); |
| 2999 | if (!err) |
| 3000 | done = 1; |
| 3001 | release_sock(&tsk->sk); |
| 3002 | tipc_sk_put(tsk); |
| 3003 | |
| 3004 | cb->args[0] = tsk_ref; |
| 3005 | cb->args[1] = last_publ; |
| 3006 | cb->args[2] = done; |
| 3007 | |
| 3008 | return skb->len; |
| 3009 | } |