1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33#include <linux/kernel.h>
34#include <linux/gfp.h>
35#include <linux/in.h>
36#include <net/tcp.h>
37
38#include "rds.h"
39#include "tcp.h"
40
41void rds_tcp_keepalive(struct socket *sock)
42{
43
44 int keepidle = 5;
45 int keepcnt = 5;
46
47 sock_set_keepalive(sock->sk);
48 tcp_sock_set_keepcnt(sock->sk, keepcnt);
49 tcp_sock_set_keepidle(sock->sk, keepidle);
50
51
52
53 tcp_sock_set_keepintvl(sock->sk, keepidle);
54}
55
56
57
58
59
60
61
62
63
64
65static
66struct rds_tcp_connection *rds_tcp_accept_one_path(struct rds_connection *conn)
67{
68 int i;
69 int npaths = max_t(int, 1, conn->c_npaths);
70
71
72
73
74 if (rds_addr_cmp(&conn->c_faddr, &conn->c_laddr) >= 0) {
75
76
77
78
79 if (npaths == 1)
80 rds_conn_path_connect_if_down(&conn->c_path[0]);
81 return NULL;
82 }
83
84 for (i = 0; i < npaths; i++) {
85 struct rds_conn_path *cp = &conn->c_path[i];
86
87 if (rds_conn_path_transition(cp, RDS_CONN_DOWN,
88 RDS_CONN_CONNECTING) ||
89 rds_conn_path_transition(cp, RDS_CONN_ERROR,
90 RDS_CONN_CONNECTING)) {
91 return cp->cp_transport_data;
92 }
93 }
94 return NULL;
95}
96
97int rds_tcp_accept_one(struct socket *sock)
98{
99 struct socket *new_sock = NULL;
100 struct rds_connection *conn;
101 int ret;
102 struct inet_sock *inet;
103 struct rds_tcp_connection *rs_tcp = NULL;
104 int conn_state;
105 struct rds_conn_path *cp;
106 struct in6_addr *my_addr, *peer_addr;
107#if !IS_ENABLED(CONFIG_IPV6)
108 struct in6_addr saddr, daddr;
109#endif
110 int dev_if = 0;
111
112 if (!sock)
113 return -ENETUNREACH;
114
115 ret = sock_create_lite(sock->sk->sk_family,
116 sock->sk->sk_type, sock->sk->sk_protocol,
117 &new_sock);
118 if (ret)
119 goto out;
120
121 ret = sock->ops->accept(sock, new_sock, O_NONBLOCK, true);
122 if (ret < 0)
123 goto out;
124
125
126
127
128
129
130
131
132 new_sock->ops = sock->ops;
133 __module_get(new_sock->ops->owner);
134
135 rds_tcp_keepalive(new_sock);
136 rds_tcp_tune(new_sock);
137
138 inet = inet_sk(new_sock->sk);
139
140#if IS_ENABLED(CONFIG_IPV6)
141 my_addr = &new_sock->sk->sk_v6_rcv_saddr;
142 peer_addr = &new_sock->sk->sk_v6_daddr;
143#else
144 ipv6_addr_set_v4mapped(inet->inet_saddr, &saddr);
145 ipv6_addr_set_v4mapped(inet->inet_daddr, &daddr);
146 my_addr = &saddr;
147 peer_addr = &daddr;
148#endif
149 rdsdebug("accepted family %d tcp %pI6c:%u -> %pI6c:%u\n",
150 sock->sk->sk_family,
151 my_addr, ntohs(inet->inet_sport),
152 peer_addr, ntohs(inet->inet_dport));
153
154#if IS_ENABLED(CONFIG_IPV6)
155
156
157
158
159 if ((ipv6_addr_type(my_addr) & IPV6_ADDR_LINKLOCAL) &&
160 !(ipv6_addr_type(peer_addr) & IPV6_ADDR_LINKLOCAL)) {
161 struct ipv6_pinfo *inet6;
162
163 inet6 = inet6_sk(new_sock->sk);
164 dev_if = inet6->mcast_oif;
165 } else {
166 dev_if = new_sock->sk->sk_bound_dev_if;
167 }
168#endif
169
170 if (!rds_tcp_laddr_check(sock_net(sock->sk), peer_addr, dev_if)) {
171
172 ret = -EOPNOTSUPP;
173 goto out;
174 }
175
176 conn = rds_conn_create(sock_net(sock->sk),
177 my_addr, peer_addr,
178 &rds_tcp_transport, 0, GFP_KERNEL, dev_if);
179
180 if (IS_ERR(conn)) {
181 ret = PTR_ERR(conn);
182 goto out;
183 }
184
185
186
187
188
189 rs_tcp = rds_tcp_accept_one_path(conn);
190 if (!rs_tcp)
191 goto rst_nsk;
192 mutex_lock(&rs_tcp->t_conn_path_lock);
193 cp = rs_tcp->t_cpath;
194 conn_state = rds_conn_path_state(cp);
195 WARN_ON(conn_state == RDS_CONN_UP);
196 if (conn_state != RDS_CONN_CONNECTING && conn_state != RDS_CONN_ERROR)
197 goto rst_nsk;
198 if (rs_tcp->t_sock) {
199
200 rds_tcp_reset_callbacks(new_sock, cp);
201
202 rds_connect_path_complete(cp, RDS_CONN_RESETTING);
203 } else {
204 rds_tcp_set_callbacks(new_sock, cp);
205 rds_connect_path_complete(cp, RDS_CONN_CONNECTING);
206 }
207 new_sock = NULL;
208 ret = 0;
209 if (conn->c_npaths == 0)
210 rds_send_ping(cp->cp_conn, cp->cp_index);
211 goto out;
212rst_nsk:
213
214
215
216
217
218
219 sock_no_linger(new_sock->sk);
220 kernel_sock_shutdown(new_sock, SHUT_RDWR);
221 ret = 0;
222out:
223 if (rs_tcp)
224 mutex_unlock(&rs_tcp->t_conn_path_lock);
225 if (new_sock)
226 sock_release(new_sock);
227 return ret;
228}
229
230void rds_tcp_listen_data_ready(struct sock *sk)
231{
232 void (*ready)(struct sock *sk);
233
234 rdsdebug("listen data ready sk %p\n", sk);
235
236 read_lock_bh(&sk->sk_callback_lock);
237 ready = sk->sk_user_data;
238 if (!ready) {
239 ready = sk->sk_data_ready;
240 goto out;
241 }
242
243
244
245
246
247
248
249
250
251
252 if (sk->sk_state == TCP_LISTEN)
253 rds_tcp_accept_work(sk);
254 else
255 ready = rds_tcp_listen_sock_def_readable(sock_net(sk));
256
257out:
258 read_unlock_bh(&sk->sk_callback_lock);
259 if (ready)
260 ready(sk);
261}
262
263struct socket *rds_tcp_listen_init(struct net *net, bool isv6)
264{
265 struct socket *sock = NULL;
266 struct sockaddr_storage ss;
267 struct sockaddr_in6 *sin6;
268 struct sockaddr_in *sin;
269 int addr_len;
270 int ret;
271
272 ret = sock_create_kern(net, isv6 ? PF_INET6 : PF_INET, SOCK_STREAM,
273 IPPROTO_TCP, &sock);
274 if (ret < 0) {
275 rdsdebug("could not create %s listener socket: %d\n",
276 isv6 ? "IPv6" : "IPv4", ret);
277 goto out;
278 }
279
280 sock->sk->sk_reuse = SK_CAN_REUSE;
281 tcp_sock_set_nodelay(sock->sk);
282
283 write_lock_bh(&sock->sk->sk_callback_lock);
284 sock->sk->sk_user_data = sock->sk->sk_data_ready;
285 sock->sk->sk_data_ready = rds_tcp_listen_data_ready;
286 write_unlock_bh(&sock->sk->sk_callback_lock);
287
288 if (isv6) {
289 sin6 = (struct sockaddr_in6 *)&ss;
290 sin6->sin6_family = PF_INET6;
291 sin6->sin6_addr = in6addr_any;
292 sin6->sin6_port = (__force u16)htons(RDS_TCP_PORT);
293 sin6->sin6_scope_id = 0;
294 sin6->sin6_flowinfo = 0;
295 addr_len = sizeof(*sin6);
296 } else {
297 sin = (struct sockaddr_in *)&ss;
298 sin->sin_family = PF_INET;
299 sin->sin_addr.s_addr = INADDR_ANY;
300 sin->sin_port = (__force u16)htons(RDS_TCP_PORT);
301 addr_len = sizeof(*sin);
302 }
303
304 ret = sock->ops->bind(sock, (struct sockaddr *)&ss, addr_len);
305 if (ret < 0) {
306 rdsdebug("could not bind %s listener socket: %d\n",
307 isv6 ? "IPv6" : "IPv4", ret);
308 goto out;
309 }
310
311 ret = sock->ops->listen(sock, 64);
312 if (ret < 0)
313 goto out;
314
315 return sock;
316out:
317 if (sock)
318 sock_release(sock);
319 return NULL;
320}
321
322void rds_tcp_listen_stop(struct socket *sock, struct work_struct *acceptor)
323{
324 struct sock *sk;
325
326 if (!sock)
327 return;
328
329 sk = sock->sk;
330
331
332 lock_sock(sk);
333 write_lock_bh(&sk->sk_callback_lock);
334 if (sk->sk_user_data) {
335 sk->sk_data_ready = sk->sk_user_data;
336 sk->sk_user_data = NULL;
337 }
338 write_unlock_bh(&sk->sk_callback_lock);
339 release_sock(sk);
340
341
342 flush_workqueue(rds_wq);
343 flush_work(acceptor);
344 sock_release(sock);
345}
346