projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
ARM: 8618/1: decompressor: reset ttbcr fields to use TTBR0 on ARMv7
[deliverable/linux.git] / drivers / infiniband / hw / cxgb4 / cm.c
1 /*
2 * Copyright (c) 2009-2014 Chelsio, Inc. All rights reserved.
3 *
4 * This software is available to you under a choice of one of two
5 * licenses. You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
9 *
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
12 * conditions are met:
13 *
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
16 * disclaimer.
17 *
18 * - Redistributions in binary form must reproduce the above
19 * copyright notice, this list of conditions and the following
20 * disclaimer in the documentation and/or other materials
21 * provided with the distribution.
22 *
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30 * SOFTWARE.
31 */
32 #include <linux/module.h>
33 #include <linux/list.h>
34 #include <linux/workqueue.h>
35 #include <linux/skbuff.h>
36 #include <linux/timer.h>
37 #include <linux/notifier.h>
38 #include <linux/inetdevice.h>
39 #include <linux/ip.h>
40 #include <linux/tcp.h>
41 #include <linux/if_vlan.h>
42
43 #include <net/neighbour.h>
44 #include <net/netevent.h>
45 #include <net/route.h>
46 #include <net/tcp.h>
47 #include <net/ip6_route.h>
48 #include <net/addrconf.h>
49
50 #include <rdma/ib_addr.h>
51
52 #include "iw_cxgb4.h"
53 #include "clip_tbl.h"
54
55 static char *states[] = {
56 "idle",
57 "listen",
58 "connecting",
59 "mpa_wait_req",
60 "mpa_req_sent",
61 "mpa_req_rcvd",
62 "mpa_rep_sent",
63 "fpdu_mode",
64 "aborting",
65 "closing",
66 "moribund",
67 "dead",
68 NULL,
69 };
70
71 static int nocong;
72 module_param(nocong, int, 0644);
73 MODULE_PARM_DESC(nocong, "Turn of congestion control (default=0)");
74
75 static int enable_ecn;
76 module_param(enable_ecn, int, 0644);
77 MODULE_PARM_DESC(enable_ecn, "Enable ECN (default=0/disabled)");
78
79 static int dack_mode = 1;
80 module_param(dack_mode, int, 0644);
81 MODULE_PARM_DESC(dack_mode, "Delayed ack mode (default=1)");
82
83 uint c4iw_max_read_depth = 32;
84 module_param(c4iw_max_read_depth, int, 0644);
85 MODULE_PARM_DESC(c4iw_max_read_depth,
86 "Per-connection max ORD/IRD (default=32)");
87
88 static int enable_tcp_timestamps;
89 module_param(enable_tcp_timestamps, int, 0644);
90 MODULE_PARM_DESC(enable_tcp_timestamps, "Enable tcp timestamps (default=0)");
91
92 static int enable_tcp_sack;
93 module_param(enable_tcp_sack, int, 0644);
94 MODULE_PARM_DESC(enable_tcp_sack, "Enable tcp SACK (default=0)");
95
96 static int enable_tcp_window_scaling = 1;
97 module_param(enable_tcp_window_scaling, int, 0644);
98 MODULE_PARM_DESC(enable_tcp_window_scaling,
99 "Enable tcp window scaling (default=1)");
100
101 int c4iw_debug;
102 module_param(c4iw_debug, int, 0644);
103 MODULE_PARM_DESC(c4iw_debug, "Enable debug logging (default=0)");
104
105 static int peer2peer = 1;
106 module_param(peer2peer, int, 0644);
107 MODULE_PARM_DESC(peer2peer, "Support peer2peer ULPs (default=1)");
108
109 static int p2p_type = FW_RI_INIT_P2PTYPE_READ_REQ;
110 module_param(p2p_type, int, 0644);
111 MODULE_PARM_DESC(p2p_type, "RDMAP opcode to use for the RTR message: "
112 "1=RDMA_READ 0=RDMA_WRITE (default 1)");
113
114 static int ep_timeout_secs = 60;
115 module_param(ep_timeout_secs, int, 0644);
116 MODULE_PARM_DESC(ep_timeout_secs, "CM Endpoint operation timeout "
117 "in seconds (default=60)");
118
119 static int mpa_rev = 2;
120 module_param(mpa_rev, int, 0644);
121 MODULE_PARM_DESC(mpa_rev, "MPA Revision, 0 supports amso1100, "
122 "1 is RFC5044 spec compliant, 2 is IETF MPA Peer Connect Draft"
123 " compliant (default=2)");
124
125 static int markers_enabled;
126 module_param(markers_enabled, int, 0644);
127 MODULE_PARM_DESC(markers_enabled, "Enable MPA MARKERS (default(0)=disabled)");
128
129 static int crc_enabled = 1;
130 module_param(crc_enabled, int, 0644);
131 MODULE_PARM_DESC(crc_enabled, "Enable MPA CRC (default(1)=enabled)");
132
133 static int rcv_win = 256 * 1024;
134 module_param(rcv_win, int, 0644);
135 MODULE_PARM_DESC(rcv_win, "TCP receive window in bytes (default=256KB)");
136
137 static int snd_win = 128 * 1024;
138 module_param(snd_win, int, 0644);
139 MODULE_PARM_DESC(snd_win, "TCP send window in bytes (default=128KB)");
140
141 static struct workqueue_struct *workq;
142
143 static struct sk_buff_head rxq;
144
145 static struct sk_buff *get_skb(struct sk_buff *skb, int len, gfp_t gfp);
146 static void ep_timeout(unsigned long arg);
147 static void connect_reply_upcall(struct c4iw_ep *ep, int status);
148 static int sched(struct c4iw_dev *dev, struct sk_buff *skb);
149
150 static LIST_HEAD(timeout_list);
151 static spinlock_t timeout_lock;
152
153 static void deref_cm_id(struct c4iw_ep_common *epc)
154 {
155 epc->cm_id->rem_ref(epc->cm_id);
156 epc->cm_id = NULL;
157 set_bit(CM_ID_DEREFED, &epc->history);
158 }
159
160 static void ref_cm_id(struct c4iw_ep_common *epc)
161 {
162 set_bit(CM_ID_REFED, &epc->history);
163 epc->cm_id->add_ref(epc->cm_id);
164 }
165
166 static void deref_qp(struct c4iw_ep *ep)
167 {
168 c4iw_qp_rem_ref(&ep->com.qp->ibqp);
169 clear_bit(QP_REFERENCED, &ep->com.flags);
170 set_bit(QP_DEREFED, &ep->com.history);
171 }
172
173 static void ref_qp(struct c4iw_ep *ep)
174 {
175 set_bit(QP_REFERENCED, &ep->com.flags);
176 set_bit(QP_REFED, &ep->com.history);
177 c4iw_qp_add_ref(&ep->com.qp->ibqp);
178 }
179
180 static void start_ep_timer(struct c4iw_ep *ep)
181 {
182 PDBG("%s ep %p\n", __func__, ep);
183 if (timer_pending(&ep->timer)) {
184 pr_err("%s timer already started! ep %p\n",
185 __func__, ep);
186 return;
187 }
188 clear_bit(TIMEOUT, &ep->com.flags);
189 c4iw_get_ep(&ep->com);
190 ep->timer.expires = jiffies + ep_timeout_secs * HZ;
191 ep->timer.data = (unsigned long)ep;
192 ep->timer.function = ep_timeout;
193 add_timer(&ep->timer);
194 }
195
196 static int stop_ep_timer(struct c4iw_ep *ep)
197 {
198 PDBG("%s ep %p stopping\n", __func__, ep);
199 del_timer_sync(&ep->timer);
200 if (!test_and_set_bit(TIMEOUT, &ep->com.flags)) {
201 c4iw_put_ep(&ep->com);
202 return 0;
203 }
204 return 1;
205 }
206
207 static int c4iw_l2t_send(struct c4iw_rdev *rdev, struct sk_buff *skb,
208 struct l2t_entry *l2e)
209 {
210 int error = 0;
211
212 if (c4iw_fatal_error(rdev)) {
213 kfree_skb(skb);
214 PDBG("%s - device in error state - dropping\n", __func__);
215 return -EIO;
216 }
217 error = cxgb4_l2t_send(rdev->lldi.ports[0], skb, l2e);
218 if (error < 0)
219 kfree_skb(skb);
220 else if (error == NET_XMIT_DROP)
221 return -ENOMEM;
222 return error < 0 ? error : 0;
223 }
224
225 int c4iw_ofld_send(struct c4iw_rdev *rdev, struct sk_buff *skb)
226 {
227 int error = 0;
228
229 if (c4iw_fatal_error(rdev)) {
230 kfree_skb(skb);
231 PDBG("%s - device in error state - dropping\n", __func__);
232 return -EIO;
233 }
234 error = cxgb4_ofld_send(rdev->lldi.ports[0], skb);
235 if (error < 0)
236 kfree_skb(skb);
237 return error < 0 ? error : 0;
238 }
239
240 static void release_tid(struct c4iw_rdev *rdev, u32 hwtid, struct sk_buff *skb)
241 {
242 struct cpl_tid_release *req;
243
244 skb = get_skb(skb, sizeof *req, GFP_KERNEL);
245 if (!skb)
246 return;
247 req = (struct cpl_tid_release *) skb_put(skb, sizeof(*req));
248 INIT_TP_WR(req, hwtid);
249 OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_TID_RELEASE, hwtid));
250 set_wr_txq(skb, CPL_PRIORITY_SETUP, 0);
251 c4iw_ofld_send(rdev, skb);
252 return;
253 }
254
255 static void set_emss(struct c4iw_ep *ep, u16 opt)
256 {
257 ep->emss = ep->com.dev->rdev.lldi.mtus[TCPOPT_MSS_G(opt)] -
258 ((AF_INET == ep->com.remote_addr.ss_family) ?
259 sizeof(struct iphdr) : sizeof(struct ipv6hdr)) -
260 sizeof(struct tcphdr);
261 ep->mss = ep->emss;
262 if (TCPOPT_TSTAMP_G(opt))
263 ep->emss -= round_up(TCPOLEN_TIMESTAMP, 4);
264 if (ep->emss < 128)
265 ep->emss = 128;
266 if (ep->emss & 7)
267 PDBG("Warning: misaligned mtu idx %u mss %u emss=%u\n",
268 TCPOPT_MSS_G(opt), ep->mss, ep->emss);
269 PDBG("%s mss_idx %u mss %u emss=%u\n", __func__, TCPOPT_MSS_G(opt),
270 ep->mss, ep->emss);
271 }
272
273 static enum c4iw_ep_state state_read(struct c4iw_ep_common *epc)
274 {
275 enum c4iw_ep_state state;
276
277 mutex_lock(&epc->mutex);
278 state = epc->state;
279 mutex_unlock(&epc->mutex);
280 return state;
281 }
282
283 static void __state_set(struct c4iw_ep_common *epc, enum c4iw_ep_state new)
284 {
285 epc->state = new;
286 }
287
288 static void state_set(struct c4iw_ep_common *epc, enum c4iw_ep_state new)
289 {
290 mutex_lock(&epc->mutex);
291 PDBG("%s - %s -> %s\n", __func__, states[epc->state], states[new]);
292 __state_set(epc, new);
293 mutex_unlock(&epc->mutex);
294 return;
295 }
296
297 static int alloc_ep_skb_list(struct sk_buff_head *ep_skb_list, int size)
298 {
299 struct sk_buff *skb;
300 unsigned int i;
301 size_t len;
302
303 len = roundup(sizeof(union cpl_wr_size), 16);
304 for (i = 0; i < size; i++) {
305 skb = alloc_skb(len, GFP_KERNEL);
306 if (!skb)
307 goto fail;
308 skb_queue_tail(ep_skb_list, skb);
309 }
310 return 0;
311 fail:
312 skb_queue_purge(ep_skb_list);
313 return -ENOMEM;
314 }
315
316 static void *alloc_ep(int size, gfp_t gfp)
317 {
318 struct c4iw_ep_common *epc;
319
320 epc = kzalloc(size, gfp);
321 if (epc) {
322 kref_init(&epc->kref);
323 mutex_init(&epc->mutex);
324 c4iw_init_wr_wait(&epc->wr_wait);
325 }
326 PDBG("%s alloc ep %p\n", __func__, epc);
327 return epc;
328 }
329
330 static void remove_ep_tid(struct c4iw_ep *ep)
331 {
332 unsigned long flags;
333
334 spin_lock_irqsave(&ep->com.dev->lock, flags);
335 _remove_handle(ep->com.dev, &ep->com.dev->hwtid_idr, ep->hwtid, 0);
336 spin_unlock_irqrestore(&ep->com.dev->lock, flags);
337 }
338
339 static void insert_ep_tid(struct c4iw_ep *ep)
340 {
341 unsigned long flags;
342
343 spin_lock_irqsave(&ep->com.dev->lock, flags);
344 _insert_handle(ep->com.dev, &ep->com.dev->hwtid_idr, ep, ep->hwtid, 0);
345 spin_unlock_irqrestore(&ep->com.dev->lock, flags);
346 }
347
348 /*
349 * Atomically lookup the ep ptr given the tid and grab a reference on the ep.
350 */
351 static struct c4iw_ep *get_ep_from_tid(struct c4iw_dev *dev, unsigned int tid)
352 {
353 struct c4iw_ep *ep;
354 unsigned long flags;
355
356 spin_lock_irqsave(&dev->lock, flags);
357 ep = idr_find(&dev->hwtid_idr, tid);
358 if (ep)
359 c4iw_get_ep(&ep->com);
360 spin_unlock_irqrestore(&dev->lock, flags);
361 return ep;
362 }
363
364 /*
365 * Atomically lookup the ep ptr given the stid and grab a reference on the ep.
366 */
367 static struct c4iw_listen_ep *get_ep_from_stid(struct c4iw_dev *dev,
368 unsigned int stid)
369 {
370 struct c4iw_listen_ep *ep;
371 unsigned long flags;
372
373 spin_lock_irqsave(&dev->lock, flags);
374 ep = idr_find(&dev->stid_idr, stid);
375 if (ep)
376 c4iw_get_ep(&ep->com);
377 spin_unlock_irqrestore(&dev->lock, flags);
378 return ep;
379 }
380
381 void _c4iw_free_ep(struct kref *kref)
382 {
383 struct c4iw_ep *ep;
384
385 ep = container_of(kref, struct c4iw_ep, com.kref);
386 PDBG("%s ep %p state %s\n", __func__, ep, states[ep->com.state]);
387 if (test_bit(QP_REFERENCED, &ep->com.flags))
388 deref_qp(ep);
389 if (test_bit(RELEASE_RESOURCES, &ep->com.flags)) {
390 if (ep->com.remote_addr.ss_family == AF_INET6) {
391 struct sockaddr_in6 *sin6 =
392 (struct sockaddr_in6 *)
393 &ep->com.local_addr;
394
395 cxgb4_clip_release(
396 ep->com.dev->rdev.lldi.ports[0],
397 (const u32 *)&sin6->sin6_addr.s6_addr,
398 1);
399 }
400 cxgb4_remove_tid(ep->com.dev->rdev.lldi.tids, 0, ep->hwtid);
401 dst_release(ep->dst);
402 cxgb4_l2t_release(ep->l2t);
403 if (ep->mpa_skb)
404 kfree_skb(ep->mpa_skb);
405 }
406 if (!skb_queue_empty(&ep->com.ep_skb_list))
407 skb_queue_purge(&ep->com.ep_skb_list);
408 kfree(ep);
409 }
410
411 static void release_ep_resources(struct c4iw_ep *ep)
412 {
413 set_bit(RELEASE_RESOURCES, &ep->com.flags);
414
415 /*
416 * If we have a hwtid, then remove it from the idr table
417 * so lookups will no longer find this endpoint. Otherwise
418 * we have a race where one thread finds the ep ptr just
419 * before the other thread is freeing the ep memory.
420 */
421 if (ep->hwtid != -1)
422 remove_ep_tid(ep);
423 c4iw_put_ep(&ep->com);
424 }
425
426 static int status2errno(int status)
427 {
428 switch (status) {
429 case CPL_ERR_NONE:
430 return 0;
431 case CPL_ERR_CONN_RESET:
432 return -ECONNRESET;
433 case CPL_ERR_ARP_MISS:
434 return -EHOSTUNREACH;
435 case CPL_ERR_CONN_TIMEDOUT:
436 return -ETIMEDOUT;
437 case CPL_ERR_TCAM_FULL:
438 return -ENOMEM;
439 case CPL_ERR_CONN_EXIST:
440 return -EADDRINUSE;
441 default:
442 return -EIO;
443 }
444 }
445
446 /*
447 * Try and reuse skbs already allocated...
448 */
449 static struct sk_buff *get_skb(struct sk_buff *skb, int len, gfp_t gfp)
450 {
451 if (skb && !skb_is_nonlinear(skb) && !skb_cloned(skb)) {
452 skb_trim(skb, 0);
453 skb_get(skb);
454 skb_reset_transport_header(skb);
455 } else {
456 skb = alloc_skb(len, gfp);
457 }
458 t4_set_arp_err_handler(skb, NULL, NULL);
459 return skb;
460 }
461
462 static struct net_device *get_real_dev(struct net_device *egress_dev)
463 {
464 return rdma_vlan_dev_real_dev(egress_dev) ? : egress_dev;
465 }
466
467 static int our_interface(struct c4iw_dev *dev, struct net_device *egress_dev)
468 {
469 int i;
470
471 egress_dev = get_real_dev(egress_dev);
472 for (i = 0; i < dev->rdev.lldi.nports; i++)
473 if (dev->rdev.lldi.ports[i] == egress_dev)
474 return 1;
475 return 0;
476 }
477
478 static struct dst_entry *find_route6(struct c4iw_dev *dev, __u8 *local_ip,
479 __u8 *peer_ip, __be16 local_port,
480 __be16 peer_port, u8 tos,
481 __u32 sin6_scope_id)
482 {
483 struct dst_entry *dst = NULL;
484
485 if (IS_ENABLED(CONFIG_IPV6)) {
486 struct flowi6 fl6;
487
488 memset(&fl6, 0, sizeof(fl6));
489 memcpy(&fl6.daddr, peer_ip, 16);
490 memcpy(&fl6.saddr, local_ip, 16);
491 if (ipv6_addr_type(&fl6.daddr) & IPV6_ADDR_LINKLOCAL)
492 fl6.flowi6_oif = sin6_scope_id;
493 dst = ip6_route_output(&init_net, NULL, &fl6);
494 if (!dst)
495 goto out;
496 if (!our_interface(dev, ip6_dst_idev(dst)->dev) &&
497 !(ip6_dst_idev(dst)->dev->flags & IFF_LOOPBACK)) {
498 dst_release(dst);
499 dst = NULL;
500 }
501 }
502
503 out:
504 return dst;
505 }
506
507 static struct dst_entry *find_route(struct c4iw_dev *dev, __be32 local_ip,
508 __be32 peer_ip, __be16 local_port,
509 __be16 peer_port, u8 tos)
510 {
511 struct rtable *rt;
512 struct flowi4 fl4;
513 struct neighbour *n;
514
515 rt = ip_route_output_ports(&init_net, &fl4, NULL, peer_ip, local_ip,
516 peer_port, local_port, IPPROTO_TCP,
517 tos, 0);
518 if (IS_ERR(rt))
519 return NULL;
520 n = dst_neigh_lookup(&rt->dst, &peer_ip);
521 if (!n)
522 return NULL;
523 if (!our_interface(dev, n->dev) &&
524 !(n->dev->flags & IFF_LOOPBACK)) {
525 neigh_release(n);
526 dst_release(&rt->dst);
527 return NULL;
528 }
529 neigh_release(n);
530 return &rt->dst;
531 }
532
533 static void arp_failure_discard(void *handle, struct sk_buff *skb)
534 {
535 pr_err(MOD "ARP failure\n");
536 kfree_skb(skb);
537 }
538
539 static void mpa_start_arp_failure(void *handle, struct sk_buff *skb)
540 {
541 pr_err("ARP failure during MPA Negotiation - Closing Connection\n");
542 }
543
544 enum {
545 NUM_FAKE_CPLS = 2,
546 FAKE_CPL_PUT_EP_SAFE = NUM_CPL_CMDS + 0,
547 FAKE_CPL_PASS_PUT_EP_SAFE = NUM_CPL_CMDS + 1,
548 };
549
550 static int _put_ep_safe(struct c4iw_dev *dev, struct sk_buff *skb)
551 {
552 struct c4iw_ep *ep;
553
554 ep = *((struct c4iw_ep **)(skb->cb + 2 * sizeof(void *)));
555 release_ep_resources(ep);
556 return 0;
557 }
558
559 static int _put_pass_ep_safe(struct c4iw_dev *dev, struct sk_buff *skb)
560 {
561 struct c4iw_ep *ep;
562
563 ep = *((struct c4iw_ep **)(skb->cb + 2 * sizeof(void *)));
564 c4iw_put_ep(&ep->parent_ep->com);
565 release_ep_resources(ep);
566 return 0;
567 }
568
569 /*
570 * Fake up a special CPL opcode and call sched() so process_work() will call
571 * _put_ep_safe() in a safe context to free the ep resources. This is needed
572 * because ARP error handlers are called in an ATOMIC context, and
573 * _c4iw_free_ep() needs to block.
574 */
575 static void queue_arp_failure_cpl(struct c4iw_ep *ep, struct sk_buff *skb,
576 int cpl)
577 {
578 struct cpl_act_establish *rpl = cplhdr(skb);
579
580 /* Set our special ARP_FAILURE opcode */
581 rpl->ot.opcode = cpl;
582
583 /*
584 * Save ep in the skb->cb area, after where sched() will save the dev
585 * ptr.
586 */
587 *((struct c4iw_ep **)(skb->cb + 2 * sizeof(void *))) = ep;
588 sched(ep->com.dev, skb);
589 }
590
591 /* Handle an ARP failure for an accept */
592 static void pass_accept_rpl_arp_failure(void *handle, struct sk_buff *skb)
593 {
594 struct c4iw_ep *ep = handle;
595
596 pr_err(MOD "ARP failure during accept - tid %u -dropping connection\n",
597 ep->hwtid);
598
599 __state_set(&ep->com, DEAD);
600 queue_arp_failure_cpl(ep, skb, FAKE_CPL_PASS_PUT_EP_SAFE);
601 }
602
603 /*
604 * Handle an ARP failure for an active open.
605 */
606 static void act_open_req_arp_failure(void *handle, struct sk_buff *skb)
607 {
608 struct c4iw_ep *ep = handle;
609
610 printk(KERN_ERR MOD "ARP failure during connect\n");
611 connect_reply_upcall(ep, -EHOSTUNREACH);
612 __state_set(&ep->com, DEAD);
613 if (ep->com.remote_addr.ss_family == AF_INET6) {
614 struct sockaddr_in6 *sin6 =
615 (struct sockaddr_in6 *)&ep->com.local_addr;
616 cxgb4_clip_release(ep->com.dev->rdev.lldi.ports[0],
617 (const u32 *)&sin6->sin6_addr.s6_addr, 1);
618 }
619 remove_handle(ep->com.dev, &ep->com.dev->atid_idr, ep->atid);
620 cxgb4_free_atid(ep->com.dev->rdev.lldi.tids, ep->atid);
621 queue_arp_failure_cpl(ep, skb, FAKE_CPL_PUT_EP_SAFE);
622 }
623
624 /*
625 * Handle an ARP failure for a CPL_ABORT_REQ. Change it into a no RST variant
626 * and send it along.
627 */
628 static void abort_arp_failure(void *handle, struct sk_buff *skb)
629 {
630 int ret;
631 struct c4iw_ep *ep = handle;
632 struct c4iw_rdev *rdev = &ep->com.dev->rdev;
633 struct cpl_abort_req *req = cplhdr(skb);
634
635 PDBG("%s rdev %p\n", __func__, rdev);
636 req->cmd = CPL_ABORT_NO_RST;
637 ret = c4iw_ofld_send(rdev, skb);
638 if (ret) {
639 __state_set(&ep->com, DEAD);
640 queue_arp_failure_cpl(ep, skb, FAKE_CPL_PUT_EP_SAFE);
641 }
642 }
643
644 static int send_flowc(struct c4iw_ep *ep)
645 {
646 struct fw_flowc_wr *flowc;
647 struct sk_buff *skb = skb_dequeue(&ep->com.ep_skb_list);
648 int i;
649 u16 vlan = ep->l2t->vlan;
650 int nparams;
651
652 if (WARN_ON(!skb))
653 return -ENOMEM;
654
655 if (vlan == CPL_L2T_VLAN_NONE)
656 nparams = 8;
657 else
658 nparams = 9;
659
660 flowc = (struct fw_flowc_wr *)__skb_put(skb, FLOWC_LEN);
661
662 flowc->op_to_nparams = cpu_to_be32(FW_WR_OP_V(FW_FLOWC_WR) |
663 FW_FLOWC_WR_NPARAMS_V(nparams));
664 flowc->flowid_len16 = cpu_to_be32(FW_WR_LEN16_V(DIV_ROUND_UP(FLOWC_LEN,
665 16)) | FW_WR_FLOWID_V(ep->hwtid));
666
667 flowc->mnemval[0].mnemonic = FW_FLOWC_MNEM_PFNVFN;
668 flowc->mnemval[0].val = cpu_to_be32(FW_PFVF_CMD_PFN_V
669 (ep->com.dev->rdev.lldi.pf));
670 flowc->mnemval[1].mnemonic = FW_FLOWC_MNEM_CH;
671 flowc->mnemval[1].val = cpu_to_be32(ep->tx_chan);
672 flowc->mnemval[2].mnemonic = FW_FLOWC_MNEM_PORT;
673 flowc->mnemval[2].val = cpu_to_be32(ep->tx_chan);
674 flowc->mnemval[3].mnemonic = FW_FLOWC_MNEM_IQID;
675 flowc->mnemval[3].val = cpu_to_be32(ep->rss_qid);
676 flowc->mnemval[4].mnemonic = FW_FLOWC_MNEM_SNDNXT;
677 flowc->mnemval[4].val = cpu_to_be32(ep->snd_seq);
678 flowc->mnemval[5].mnemonic = FW_FLOWC_MNEM_RCVNXT;
679 flowc->mnemval[5].val = cpu_to_be32(ep->rcv_seq);
680 flowc->mnemval[6].mnemonic = FW_FLOWC_MNEM_SNDBUF;
681 flowc->mnemval[6].val = cpu_to_be32(ep->snd_win);
682 flowc->mnemval[7].mnemonic = FW_FLOWC_MNEM_MSS;
683 flowc->mnemval[7].val = cpu_to_be32(ep->emss);
684 if (nparams == 9) {
685 u16 pri;
686
687 pri = (vlan & VLAN_PRIO_MASK) >> VLAN_PRIO_SHIFT;
688 flowc->mnemval[8].mnemonic = FW_FLOWC_MNEM_SCHEDCLASS;
689 flowc->mnemval[8].val = cpu_to_be32(pri);
690 } else {
691 /* Pad WR to 16 byte boundary */
692 flowc->mnemval[8].mnemonic = 0;
693 flowc->mnemval[8].val = 0;
694 }
695 for (i = 0; i < 9; i++) {
696 flowc->mnemval[i].r4[0] = 0;
697 flowc->mnemval[i].r4[1] = 0;
698 flowc->mnemval[i].r4[2] = 0;
699 }
700
701 set_wr_txq(skb, CPL_PRIORITY_DATA, ep->txq_idx);
702 return c4iw_ofld_send(&ep->com.dev->rdev, skb);
703 }
704
705 static int send_halfclose(struct c4iw_ep *ep)
706 {
707 struct cpl_close_con_req *req;
708 struct sk_buff *skb = skb_dequeue(&ep->com.ep_skb_list);
709 int wrlen = roundup(sizeof *req, 16);
710
711 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
712 if (WARN_ON(!skb))
713 return -ENOMEM;
714
715 set_wr_txq(skb, CPL_PRIORITY_DATA, ep->txq_idx);
716 t4_set_arp_err_handler(skb, NULL, arp_failure_discard);
717 req = (struct cpl_close_con_req *) skb_put(skb, wrlen);
718 memset(req, 0, wrlen);
719 INIT_TP_WR(req, ep->hwtid);
720 OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_CLOSE_CON_REQ,
721 ep->hwtid));
722 return c4iw_l2t_send(&ep->com.dev->rdev, skb, ep->l2t);
723 }
724
725 static int send_abort(struct c4iw_ep *ep)
726 {
727 struct cpl_abort_req *req;
728 int wrlen = roundup(sizeof *req, 16);
729 struct sk_buff *req_skb = skb_dequeue(&ep->com.ep_skb_list);
730
731 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
732 if (WARN_ON(!req_skb))
733 return -ENOMEM;
734
735 set_wr_txq(req_skb, CPL_PRIORITY_DATA, ep->txq_idx);
736 t4_set_arp_err_handler(req_skb, ep, abort_arp_failure);
737 req = (struct cpl_abort_req *)skb_put(req_skb, wrlen);
738 memset(req, 0, wrlen);
739 INIT_TP_WR(req, ep->hwtid);
740 OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ABORT_REQ, ep->hwtid));
741 req->cmd = CPL_ABORT_SEND_RST;
742 return c4iw_l2t_send(&ep->com.dev->rdev, req_skb, ep->l2t);
743 }
744
745 static void best_mtu(const unsigned short *mtus, unsigned short mtu,
746 unsigned int *idx, int use_ts, int ipv6)
747 {
748 unsigned short hdr_size = (ipv6 ?
749 sizeof(struct ipv6hdr) :
750 sizeof(struct iphdr)) +
751 sizeof(struct tcphdr) +
752 (use_ts ?
753 round_up(TCPOLEN_TIMESTAMP, 4) : 0);
754 unsigned short data_size = mtu - hdr_size;
755
756 cxgb4_best_aligned_mtu(mtus, hdr_size, data_size, 8, idx);
757 }
758
759 static int send_connect(struct c4iw_ep *ep)
760 {
761 struct cpl_act_open_req *req = NULL;
762 struct cpl_t5_act_open_req *t5req = NULL;
763 struct cpl_t6_act_open_req *t6req = NULL;
764 struct cpl_act_open_req6 *req6 = NULL;
765 struct cpl_t5_act_open_req6 *t5req6 = NULL;
766 struct cpl_t6_act_open_req6 *t6req6 = NULL;
767 struct sk_buff *skb;
768 u64 opt0;
769 u32 opt2;
770 unsigned int mtu_idx;
771 int wscale;
772 int win, sizev4, sizev6, wrlen;
773 struct sockaddr_in *la = (struct sockaddr_in *)
774 &ep->com.local_addr;
775 struct sockaddr_in *ra = (struct sockaddr_in *)
776 &ep->com.remote_addr;
777 struct sockaddr_in6 *la6 = (struct sockaddr_in6 *)
778 &ep->com.local_addr;
779 struct sockaddr_in6 *ra6 = (struct sockaddr_in6 *)
780 &ep->com.remote_addr;
781 int ret;
782 enum chip_type adapter_type = ep->com.dev->rdev.lldi.adapter_type;
783 u32 isn = (prandom_u32() & ~7UL) - 1;
784
785 switch (CHELSIO_CHIP_VERSION(adapter_type)) {
786 case CHELSIO_T4:
787 sizev4 = sizeof(struct cpl_act_open_req);
788 sizev6 = sizeof(struct cpl_act_open_req6);
789 break;
790 case CHELSIO_T5:
791 sizev4 = sizeof(struct cpl_t5_act_open_req);
792 sizev6 = sizeof(struct cpl_t5_act_open_req6);
793 break;
794 case CHELSIO_T6:
795 sizev4 = sizeof(struct cpl_t6_act_open_req);
796 sizev6 = sizeof(struct cpl_t6_act_open_req6);
797 break;
798 default:
799 pr_err("T%d Chip is not supported\n",
800 CHELSIO_CHIP_VERSION(adapter_type));
801 return -EINVAL;
802 }
803
804 wrlen = (ep->com.remote_addr.ss_family == AF_INET) ?
805 roundup(sizev4, 16) :
806 roundup(sizev6, 16);
807
808 PDBG("%s ep %p atid %u\n", __func__, ep, ep->atid);
809
810 skb = get_skb(NULL, wrlen, GFP_KERNEL);
811 if (!skb) {
812 printk(KERN_ERR MOD "%s - failed to alloc skb.\n",
813 __func__);
814 return -ENOMEM;
815 }
816 set_wr_txq(skb, CPL_PRIORITY_SETUP, ep->ctrlq_idx);
817
818 best_mtu(ep->com.dev->rdev.lldi.mtus, ep->mtu, &mtu_idx,
819 enable_tcp_timestamps,
820 (AF_INET == ep->com.remote_addr.ss_family) ? 0 : 1);
821 wscale = compute_wscale(rcv_win);
822
823 /*
824 * Specify the largest window that will fit in opt0. The
825 * remainder will be specified in the rx_data_ack.
826 */
827 win = ep->rcv_win >> 10;
828 if (win > RCV_BUFSIZ_M)
829 win = RCV_BUFSIZ_M;
830
831 opt0 = (nocong ? NO_CONG_F : 0) |
832 KEEP_ALIVE_F |
833 DELACK_F |
834 WND_SCALE_V(wscale) |
835 MSS_IDX_V(mtu_idx) |
836 L2T_IDX_V(ep->l2t->idx) |
837 TX_CHAN_V(ep->tx_chan) |
838 SMAC_SEL_V(ep->smac_idx) |
839 DSCP_V(ep->tos >> 2) |
840 ULP_MODE_V(ULP_MODE_TCPDDP) |
841 RCV_BUFSIZ_V(win);
842 opt2 = RX_CHANNEL_V(0) |
843 CCTRL_ECN_V(enable_ecn) |
844 RSS_QUEUE_VALID_F | RSS_QUEUE_V(ep->rss_qid);
845 if (enable_tcp_timestamps)
846 opt2 |= TSTAMPS_EN_F;
847 if (enable_tcp_sack)
848 opt2 |= SACK_EN_F;
849 if (wscale && enable_tcp_window_scaling)
850 opt2 |= WND_SCALE_EN_F;
851 if (CHELSIO_CHIP_VERSION(adapter_type) > CHELSIO_T4) {
852 if (peer2peer)
853 isn += 4;
854
855 opt2 |= T5_OPT_2_VALID_F;
856 opt2 |= CONG_CNTRL_V(CONG_ALG_TAHOE);
857 opt2 |= T5_ISS_F;
858 }
859
860 if (ep->com.remote_addr.ss_family == AF_INET6)
861 cxgb4_clip_get(ep->com.dev->rdev.lldi.ports[0],
862 (const u32 *)&la6->sin6_addr.s6_addr, 1);
863
864 t4_set_arp_err_handler(skb, ep, act_open_req_arp_failure);
865
866 if (ep->com.remote_addr.ss_family == AF_INET) {
867 switch (CHELSIO_CHIP_VERSION(adapter_type)) {
868 case CHELSIO_T4:
869 req = (struct cpl_act_open_req *)skb_put(skb, wrlen);
870 INIT_TP_WR(req, 0);
871 break;
872 case CHELSIO_T5:
873 t5req = (struct cpl_t5_act_open_req *)skb_put(skb,
874 wrlen);
875 INIT_TP_WR(t5req, 0);
876 req = (struct cpl_act_open_req *)t5req;
877 break;
878 case CHELSIO_T6:
879 t6req = (struct cpl_t6_act_open_req *)skb_put(skb,
880 wrlen);
881 INIT_TP_WR(t6req, 0);
882 req = (struct cpl_act_open_req *)t6req;
883 t5req = (struct cpl_t5_act_open_req *)t6req;
884 break;
885 default:
886 pr_err("T%d Chip is not supported\n",
887 CHELSIO_CHIP_VERSION(adapter_type));
888 ret = -EINVAL;
889 goto clip_release;
890 }
891
892 OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_ACT_OPEN_REQ,
893 ((ep->rss_qid<<14) | ep->atid)));
894 req->local_port = la->sin_port;
895 req->peer_port = ra->sin_port;
896 req->local_ip = la->sin_addr.s_addr;
897 req->peer_ip = ra->sin_addr.s_addr;
898 req->opt0 = cpu_to_be64(opt0);
899
900 if (is_t4(ep->com.dev->rdev.lldi.adapter_type)) {
901 req->params = cpu_to_be32(cxgb4_select_ntuple(
902 ep->com.dev->rdev.lldi.ports[0],
903 ep->l2t));
904 req->opt2 = cpu_to_be32(opt2);
905 } else {
906 t5req->params = cpu_to_be64(FILTER_TUPLE_V(
907 cxgb4_select_ntuple(
908 ep->com.dev->rdev.lldi.ports[0],
909 ep->l2t)));
910 t5req->rsvd = cpu_to_be32(isn);
911 PDBG("%s snd_isn %u\n", __func__, t5req->rsvd);
912 t5req->opt2 = cpu_to_be32(opt2);
913 }
914 } else {
915 switch (CHELSIO_CHIP_VERSION(adapter_type)) {
916 case CHELSIO_T4:
917 req6 = (struct cpl_act_open_req6 *)skb_put(skb, wrlen);
918 INIT_TP_WR(req6, 0);
919 break;
920 case CHELSIO_T5:
921 t5req6 = (struct cpl_t5_act_open_req6 *)skb_put(skb,
922 wrlen);
923 INIT_TP_WR(t5req6, 0);
924 req6 = (struct cpl_act_open_req6 *)t5req6;
925 break;
926 case CHELSIO_T6:
927 t6req6 = (struct cpl_t6_act_open_req6 *)skb_put(skb,
928 wrlen);
929 INIT_TP_WR(t6req6, 0);
930 req6 = (struct cpl_act_open_req6 *)t6req6;
931 t5req6 = (struct cpl_t5_act_open_req6 *)t6req6;
932 break;
933 default:
934 pr_err("T%d Chip is not supported\n",
935 CHELSIO_CHIP_VERSION(adapter_type));
936 ret = -EINVAL;
937 goto clip_release;
938 }
939
940 OPCODE_TID(req6) = cpu_to_be32(MK_OPCODE_TID(CPL_ACT_OPEN_REQ6,
941 ((ep->rss_qid<<14)|ep->atid)));
942 req6->local_port = la6->sin6_port;
943 req6->peer_port = ra6->sin6_port;
944 req6->local_ip_hi = *((__be64 *)(la6->sin6_addr.s6_addr));
945 req6->local_ip_lo = *((__be64 *)(la6->sin6_addr.s6_addr + 8));
946 req6->peer_ip_hi = *((__be64 *)(ra6->sin6_addr.s6_addr));
947 req6->peer_ip_lo = *((__be64 *)(ra6->sin6_addr.s6_addr + 8));
948 req6->opt0 = cpu_to_be64(opt0);
949
950 if (is_t4(ep->com.dev->rdev.lldi.adapter_type)) {
951 req6->params = cpu_to_be32(cxgb4_select_ntuple(
952 ep->com.dev->rdev.lldi.ports[0],
953 ep->l2t));
954 req6->opt2 = cpu_to_be32(opt2);
955 } else {
956 t5req6->params = cpu_to_be64(FILTER_TUPLE_V(
957 cxgb4_select_ntuple(
958 ep->com.dev->rdev.lldi.ports[0],
959 ep->l2t)));
960 t5req6->rsvd = cpu_to_be32(isn);
961 PDBG("%s snd_isn %u\n", __func__, t5req6->rsvd);
962 t5req6->opt2 = cpu_to_be32(opt2);
963 }
964 }
965
966 set_bit(ACT_OPEN_REQ, &ep->com.history);
967 ret = c4iw_l2t_send(&ep->com.dev->rdev, skb, ep->l2t);
968 clip_release:
969 if (ret && ep->com.remote_addr.ss_family == AF_INET6)
970 cxgb4_clip_release(ep->com.dev->rdev.lldi.ports[0],
971 (const u32 *)&la6->sin6_addr.s6_addr, 1);
972 return ret;
973 }
974
975 static int send_mpa_req(struct c4iw_ep *ep, struct sk_buff *skb,
976 u8 mpa_rev_to_use)
977 {
978 int mpalen, wrlen, ret;
979 struct fw_ofld_tx_data_wr *req;
980 struct mpa_message *mpa;
981 struct mpa_v2_conn_params mpa_v2_params;
982
983 PDBG("%s ep %p tid %u pd_len %d\n", __func__, ep, ep->hwtid, ep->plen);
984
985 BUG_ON(skb_cloned(skb));
986
987 mpalen = sizeof(*mpa) + ep->plen;
988 if (mpa_rev_to_use == 2)
989 mpalen += sizeof(struct mpa_v2_conn_params);
990 wrlen = roundup(mpalen + sizeof *req, 16);
991 skb = get_skb(skb, wrlen, GFP_KERNEL);
992 if (!skb) {
993 connect_reply_upcall(ep, -ENOMEM);
994 return -ENOMEM;
995 }
996 set_wr_txq(skb, CPL_PRIORITY_DATA, ep->txq_idx);
997
998 req = (struct fw_ofld_tx_data_wr *)skb_put(skb, wrlen);
999 memset(req, 0, wrlen);
1000 req->op_to_immdlen = cpu_to_be32(
1001 FW_WR_OP_V(FW_OFLD_TX_DATA_WR) |
1002 FW_WR_COMPL_F |
1003 FW_WR_IMMDLEN_V(mpalen));
1004 req->flowid_len16 = cpu_to_be32(
1005 FW_WR_FLOWID_V(ep->hwtid) |
1006 FW_WR_LEN16_V(wrlen >> 4));
1007 req->plen = cpu_to_be32(mpalen);
1008 req->tunnel_to_proxy = cpu_to_be32(
1009 FW_OFLD_TX_DATA_WR_FLUSH_F |
1010 FW_OFLD_TX_DATA_WR_SHOVE_F);
1011
1012 mpa = (struct mpa_message *)(req + 1);
1013 memcpy(mpa->key, MPA_KEY_REQ, sizeof(mpa->key));
1014
1015 mpa->flags = 0;
1016 if (crc_enabled)
1017 mpa->flags |= MPA_CRC;
1018 if (markers_enabled) {
1019 mpa->flags |= MPA_MARKERS;
1020 ep->mpa_attr.recv_marker_enabled = 1;
1021 } else {
1022 ep->mpa_attr.recv_marker_enabled = 0;
1023 }
1024 if (mpa_rev_to_use == 2)
1025 mpa->flags |= MPA_ENHANCED_RDMA_CONN;
1026
1027 mpa->private_data_size = htons(ep->plen);
1028 mpa->revision = mpa_rev_to_use;
1029 if (mpa_rev_to_use == 1) {
1030 ep->tried_with_mpa_v1 = 1;
1031 ep->retry_with_mpa_v1 = 0;
1032 }
1033
1034 if (mpa_rev_to_use == 2) {
1035 mpa->private_data_size = htons(ntohs(mpa->private_data_size) +
1036 sizeof (struct mpa_v2_conn_params));
1037 PDBG("%s initiator ird %u ord %u\n", __func__, ep->ird,
1038 ep->ord);
1039 mpa_v2_params.ird = htons((u16)ep->ird);
1040 mpa_v2_params.ord = htons((u16)ep->ord);
1041
1042 if (peer2peer) {
1043 mpa_v2_params.ird |= htons(MPA_V2_PEER2PEER_MODEL);
1044 if (p2p_type == FW_RI_INIT_P2PTYPE_RDMA_WRITE)
1045 mpa_v2_params.ord |=
1046 htons(MPA_V2_RDMA_WRITE_RTR);
1047 else if (p2p_type == FW_RI_INIT_P2PTYPE_READ_REQ)
1048 mpa_v2_params.ord |=
1049 htons(MPA_V2_RDMA_READ_RTR);
1050 }
1051 memcpy(mpa->private_data, &mpa_v2_params,
1052 sizeof(struct mpa_v2_conn_params));
1053
1054 if (ep->plen)
1055 memcpy(mpa->private_data +
1056 sizeof(struct mpa_v2_conn_params),
1057 ep->mpa_pkt + sizeof(*mpa), ep->plen);
1058 } else
1059 if (ep->plen)
1060 memcpy(mpa->private_data,
1061 ep->mpa_pkt + sizeof(*mpa), ep->plen);
1062
1063 /*
1064 * Reference the mpa skb. This ensures the data area
1065 * will remain in memory until the hw acks the tx.
1066 * Function fw4_ack() will deref it.
1067 */
1068 skb_get(skb);
1069 t4_set_arp_err_handler(skb, NULL, arp_failure_discard);
1070 BUG_ON(ep->mpa_skb);
1071 ep->mpa_skb = skb;
1072 ret = c4iw_l2t_send(&ep->com.dev->rdev, skb, ep->l2t);
1073 if (ret)
1074 return ret;
1075 start_ep_timer(ep);
1076 __state_set(&ep->com, MPA_REQ_SENT);
1077 ep->mpa_attr.initiator = 1;
1078 ep->snd_seq += mpalen;
1079 return ret;
1080 }
1081
1082 static int send_mpa_reject(struct c4iw_ep *ep, const void *pdata, u8 plen)
1083 {
1084 int mpalen, wrlen;
1085 struct fw_ofld_tx_data_wr *req;
1086 struct mpa_message *mpa;
1087 struct sk_buff *skb;
1088 struct mpa_v2_conn_params mpa_v2_params;
1089
1090 PDBG("%s ep %p tid %u pd_len %d\n", __func__, ep, ep->hwtid, ep->plen);
1091
1092 mpalen = sizeof(*mpa) + plen;
1093 if (ep->mpa_attr.version == 2 && ep->mpa_attr.enhanced_rdma_conn)
1094 mpalen += sizeof(struct mpa_v2_conn_params);
1095 wrlen = roundup(mpalen + sizeof *req, 16);
1096
1097 skb = get_skb(NULL, wrlen, GFP_KERNEL);
1098 if (!skb) {
1099 printk(KERN_ERR MOD "%s - cannot alloc skb!\n", __func__);
1100 return -ENOMEM;
1101 }
1102 set_wr_txq(skb, CPL_PRIORITY_DATA, ep->txq_idx);
1103
1104 req = (struct fw_ofld_tx_data_wr *)skb_put(skb, wrlen);
1105 memset(req, 0, wrlen);
1106 req->op_to_immdlen = cpu_to_be32(
1107 FW_WR_OP_V(FW_OFLD_TX_DATA_WR) |
1108 FW_WR_COMPL_F |
1109 FW_WR_IMMDLEN_V(mpalen));
1110 req->flowid_len16 = cpu_to_be32(
1111 FW_WR_FLOWID_V(ep->hwtid) |
1112 FW_WR_LEN16_V(wrlen >> 4));
1113 req->plen = cpu_to_be32(mpalen);
1114 req->tunnel_to_proxy = cpu_to_be32(
1115 FW_OFLD_TX_DATA_WR_FLUSH_F |
1116 FW_OFLD_TX_DATA_WR_SHOVE_F);
1117
1118 mpa = (struct mpa_message *)(req + 1);
1119 memset(mpa, 0, sizeof(*mpa));
1120 memcpy(mpa->key, MPA_KEY_REP, sizeof(mpa->key));
1121 mpa->flags = MPA_REJECT;
1122 mpa->revision = ep->mpa_attr.version;
1123 mpa->private_data_size = htons(plen);
1124
1125 if (ep->mpa_attr.version == 2 && ep->mpa_attr.enhanced_rdma_conn) {
1126 mpa->flags |= MPA_ENHANCED_RDMA_CONN;
1127 mpa->private_data_size = htons(ntohs(mpa->private_data_size) +
1128 sizeof (struct mpa_v2_conn_params));
1129 mpa_v2_params.ird = htons(((u16)ep->ird) |
1130 (peer2peer ? MPA_V2_PEER2PEER_MODEL :
1131 0));
1132 mpa_v2_params.ord = htons(((u16)ep->ord) | (peer2peer ?
1133 (p2p_type ==
1134 FW_RI_INIT_P2PTYPE_RDMA_WRITE ?
1135 MPA_V2_RDMA_WRITE_RTR : p2p_type ==
1136 FW_RI_INIT_P2PTYPE_READ_REQ ?
1137 MPA_V2_RDMA_READ_RTR : 0) : 0));
1138 memcpy(mpa->private_data, &mpa_v2_params,
1139 sizeof(struct mpa_v2_conn_params));
1140
1141 if (ep->plen)
1142 memcpy(mpa->private_data +
1143 sizeof(struct mpa_v2_conn_params), pdata, plen);
1144 } else
1145 if (plen)
1146 memcpy(mpa->private_data, pdata, plen);
1147
1148 /*
1149 * Reference the mpa skb again. This ensures the data area
1150 * will remain in memory until the hw acks the tx.
1151 * Function fw4_ack() will deref it.
1152 */
1153 skb_get(skb);
1154 set_wr_txq(skb, CPL_PRIORITY_DATA, ep->txq_idx);
1155 t4_set_arp_err_handler(skb, NULL, mpa_start_arp_failure);
1156 BUG_ON(ep->mpa_skb);
1157 ep->mpa_skb = skb;
1158 ep->snd_seq += mpalen;
1159 return c4iw_l2t_send(&ep->com.dev->rdev, skb, ep->l2t);
1160 }
1161
1162 static int send_mpa_reply(struct c4iw_ep *ep, const void *pdata, u8 plen)
1163 {
1164 int mpalen, wrlen;
1165 struct fw_ofld_tx_data_wr *req;
1166 struct mpa_message *mpa;
1167 struct sk_buff *skb;
1168 struct mpa_v2_conn_params mpa_v2_params;
1169
1170 PDBG("%s ep %p tid %u pd_len %d\n", __func__, ep, ep->hwtid, ep->plen);
1171
1172 mpalen = sizeof(*mpa) + plen;
1173 if (ep->mpa_attr.version == 2 && ep->mpa_attr.enhanced_rdma_conn)
1174 mpalen += sizeof(struct mpa_v2_conn_params);
1175 wrlen = roundup(mpalen + sizeof *req, 16);
1176
1177 skb = get_skb(NULL, wrlen, GFP_KERNEL);
1178 if (!skb) {
1179 printk(KERN_ERR MOD "%s - cannot alloc skb!\n", __func__);
1180 return -ENOMEM;
1181 }
1182 set_wr_txq(skb, CPL_PRIORITY_DATA, ep->txq_idx);
1183
1184 req = (struct fw_ofld_tx_data_wr *) skb_put(skb, wrlen);
1185 memset(req, 0, wrlen);
1186 req->op_to_immdlen = cpu_to_be32(
1187 FW_WR_OP_V(FW_OFLD_TX_DATA_WR) |
1188 FW_WR_COMPL_F |
1189 FW_WR_IMMDLEN_V(mpalen));
1190 req->flowid_len16 = cpu_to_be32(
1191 FW_WR_FLOWID_V(ep->hwtid) |
1192 FW_WR_LEN16_V(wrlen >> 4));
1193 req->plen = cpu_to_be32(mpalen);
1194 req->tunnel_to_proxy = cpu_to_be32(
1195 FW_OFLD_TX_DATA_WR_FLUSH_F |
1196 FW_OFLD_TX_DATA_WR_SHOVE_F);
1197
1198 mpa = (struct mpa_message *)(req + 1);
1199 memset(mpa, 0, sizeof(*mpa));
1200 memcpy(mpa->key, MPA_KEY_REP, sizeof(mpa->key));
1201 mpa->flags = 0;
1202 if (ep->mpa_attr.crc_enabled)
1203 mpa->flags |= MPA_CRC;
1204 if (ep->mpa_attr.recv_marker_enabled)
1205 mpa->flags |= MPA_MARKERS;
1206 mpa->revision = ep->mpa_attr.version;
1207 mpa->private_data_size = htons(plen);
1208
1209 if (ep->mpa_attr.version == 2 && ep->mpa_attr.enhanced_rdma_conn) {
1210 mpa->flags |= MPA_ENHANCED_RDMA_CONN;
1211 mpa->private_data_size = htons(ntohs(mpa->private_data_size) +
1212 sizeof (struct mpa_v2_conn_params));
1213 mpa_v2_params.ird = htons((u16)ep->ird);
1214 mpa_v2_params.ord = htons((u16)ep->ord);
1215 if (peer2peer && (ep->mpa_attr.p2p_type !=
1216 FW_RI_INIT_P2PTYPE_DISABLED)) {
1217 mpa_v2_params.ird |= htons(MPA_V2_PEER2PEER_MODEL);
1218
1219 if (p2p_type == FW_RI_INIT_P2PTYPE_RDMA_WRITE)
1220 mpa_v2_params.ord |=
1221 htons(MPA_V2_RDMA_WRITE_RTR);
1222 else if (p2p_type == FW_RI_INIT_P2PTYPE_READ_REQ)
1223 mpa_v2_params.ord |=
1224 htons(MPA_V2_RDMA_READ_RTR);
1225 }
1226
1227 memcpy(mpa->private_data, &mpa_v2_params,
1228 sizeof(struct mpa_v2_conn_params));
1229
1230 if (ep->plen)
1231 memcpy(mpa->private_data +
1232 sizeof(struct mpa_v2_conn_params), pdata, plen);
1233 } else
1234 if (plen)
1235 memcpy(mpa->private_data, pdata, plen);
1236
1237 /*
1238 * Reference the mpa skb. This ensures the data area
1239 * will remain in memory until the hw acks the tx.
1240 * Function fw4_ack() will deref it.
1241 */
1242 skb_get(skb);
1243 t4_set_arp_err_handler(skb, NULL, mpa_start_arp_failure);
1244 ep->mpa_skb = skb;
1245 __state_set(&ep->com, MPA_REP_SENT);
1246 ep->snd_seq += mpalen;
1247 return c4iw_l2t_send(&ep->com.dev->rdev, skb, ep->l2t);
1248 }
1249
1250 static int act_establish(struct c4iw_dev *dev, struct sk_buff *skb)
1251 {
1252 struct c4iw_ep *ep;
1253 struct cpl_act_establish *req = cplhdr(skb);
1254 unsigned int tid = GET_TID(req);
1255 unsigned int atid = TID_TID_G(ntohl(req->tos_atid));
1256 struct tid_info *t = dev->rdev.lldi.tids;
1257 int ret;
1258
1259 ep = lookup_atid(t, atid);
1260
1261 PDBG("%s ep %p tid %u snd_isn %u rcv_isn %u\n", __func__, ep, tid,
1262 be32_to_cpu(req->snd_isn), be32_to_cpu(req->rcv_isn));
1263
1264 mutex_lock(&ep->com.mutex);
1265 dst_confirm(ep->dst);
1266
1267 /* setup the hwtid for this connection */
1268 ep->hwtid = tid;
1269 cxgb4_insert_tid(t, ep, tid);
1270 insert_ep_tid(ep);
1271
1272 ep->snd_seq = be32_to_cpu(req->snd_isn);
1273 ep->rcv_seq = be32_to_cpu(req->rcv_isn);
1274
1275 set_emss(ep, ntohs(req->tcp_opt));
1276
1277 /* dealloc the atid */
1278 remove_handle(ep->com.dev, &ep->com.dev->atid_idr, atid);
1279 cxgb4_free_atid(t, atid);
1280 set_bit(ACT_ESTAB, &ep->com.history);
1281
1282 /* start MPA negotiation */
1283 ret = send_flowc(ep);
1284 if (ret)
1285 goto err;
1286 if (ep->retry_with_mpa_v1)
1287 ret = send_mpa_req(ep, skb, 1);
1288 else
1289 ret = send_mpa_req(ep, skb, mpa_rev);
1290 if (ret)
1291 goto err;
1292 mutex_unlock(&ep->com.mutex);
1293 return 0;
1294 err:
1295 mutex_unlock(&ep->com.mutex);
1296 connect_reply_upcall(ep, -ENOMEM);
1297 c4iw_ep_disconnect(ep, 0, GFP_KERNEL);
1298 return 0;
1299 }
1300
1301 static void close_complete_upcall(struct c4iw_ep *ep, int status)
1302 {
1303 struct iw_cm_event event;
1304
1305 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
1306 memset(&event, 0, sizeof(event));
1307 event.event = IW_CM_EVENT_CLOSE;
1308 event.status = status;
1309 if (ep->com.cm_id) {
1310 PDBG("close complete delivered ep %p cm_id %p tid %u\n",
1311 ep, ep->com.cm_id, ep->hwtid);
1312 ep->com.cm_id->event_handler(ep->com.cm_id, &event);
1313 deref_cm_id(&ep->com);
1314 set_bit(CLOSE_UPCALL, &ep->com.history);
1315 }
1316 }
1317
1318 static void peer_close_upcall(struct c4iw_ep *ep)
1319 {
1320 struct iw_cm_event event;
1321
1322 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
1323 memset(&event, 0, sizeof(event));
1324 event.event = IW_CM_EVENT_DISCONNECT;
1325 if (ep->com.cm_id) {
1326 PDBG("peer close delivered ep %p cm_id %p tid %u\n",
1327 ep, ep->com.cm_id, ep->hwtid);
1328 ep->com.cm_id->event_handler(ep->com.cm_id, &event);
1329 set_bit(DISCONN_UPCALL, &ep->com.history);
1330 }
1331 }
1332
1333 static void peer_abort_upcall(struct c4iw_ep *ep)
1334 {
1335 struct iw_cm_event event;
1336
1337 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
1338 memset(&event, 0, sizeof(event));
1339 event.event = IW_CM_EVENT_CLOSE;
1340 event.status = -ECONNRESET;
1341 if (ep->com.cm_id) {
1342 PDBG("abort delivered ep %p cm_id %p tid %u\n", ep,
1343 ep->com.cm_id, ep->hwtid);
1344 ep->com.cm_id->event_handler(ep->com.cm_id, &event);
1345 deref_cm_id(&ep->com);
1346 set_bit(ABORT_UPCALL, &ep->com.history);
1347 }
1348 }
1349
1350 static void connect_reply_upcall(struct c4iw_ep *ep, int status)
1351 {
1352 struct iw_cm_event event;
1353
1354 PDBG("%s ep %p tid %u status %d\n", __func__, ep, ep->hwtid, status);
1355 memset(&event, 0, sizeof(event));
1356 event.event = IW_CM_EVENT_CONNECT_REPLY;
1357 event.status = status;
1358 memcpy(&event.local_addr, &ep->com.local_addr,
1359 sizeof(ep->com.local_addr));
1360 memcpy(&event.remote_addr, &ep->com.remote_addr,
1361 sizeof(ep->com.remote_addr));
1362
1363 if ((status == 0) || (status == -ECONNREFUSED)) {
1364 if (!ep->tried_with_mpa_v1) {
1365 /* this means MPA_v2 is used */
1366 event.ord = ep->ird;
1367 event.ird = ep->ord;
1368 event.private_data_len = ep->plen -
1369 sizeof(struct mpa_v2_conn_params);
1370 event.private_data = ep->mpa_pkt +
1371 sizeof(struct mpa_message) +
1372 sizeof(struct mpa_v2_conn_params);
1373 } else {
1374 /* this means MPA_v1 is used */
1375 event.ord = cur_max_read_depth(ep->com.dev);
1376 event.ird = cur_max_read_depth(ep->com.dev);
1377 event.private_data_len = ep->plen;
1378 event.private_data = ep->mpa_pkt +
1379 sizeof(struct mpa_message);
1380 }
1381 }
1382
1383 PDBG("%s ep %p tid %u status %d\n", __func__, ep,
1384 ep->hwtid, status);
1385 set_bit(CONN_RPL_UPCALL, &ep->com.history);
1386 ep->com.cm_id->event_handler(ep->com.cm_id, &event);
1387
1388 if (status < 0)
1389 deref_cm_id(&ep->com);
1390 }
1391
1392 static int connect_request_upcall(struct c4iw_ep *ep)
1393 {
1394 struct iw_cm_event event;
1395 int ret;
1396
1397 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
1398 memset(&event, 0, sizeof(event));
1399 event.event = IW_CM_EVENT_CONNECT_REQUEST;
1400 memcpy(&event.local_addr, &ep->com.local_addr,
1401 sizeof(ep->com.local_addr));
1402 memcpy(&event.remote_addr, &ep->com.remote_addr,
1403 sizeof(ep->com.remote_addr));
1404 event.provider_data = ep;
1405 if (!ep->tried_with_mpa_v1) {
1406 /* this means MPA_v2 is used */
1407 event.ord = ep->ord;
1408 event.ird = ep->ird;
1409 event.private_data_len = ep->plen -
1410 sizeof(struct mpa_v2_conn_params);
1411 event.private_data = ep->mpa_pkt + sizeof(struct mpa_message) +
1412 sizeof(struct mpa_v2_conn_params);
1413 } else {
1414 /* this means MPA_v1 is used. Send max supported */
1415 event.ord = cur_max_read_depth(ep->com.dev);
1416 event.ird = cur_max_read_depth(ep->com.dev);
1417 event.private_data_len = ep->plen;
1418 event.private_data = ep->mpa_pkt + sizeof(struct mpa_message);
1419 }
1420 c4iw_get_ep(&ep->com);
1421 ret = ep->parent_ep->com.cm_id->event_handler(ep->parent_ep->com.cm_id,
1422 &event);
1423 if (ret)
1424 c4iw_put_ep(&ep->com);
1425 set_bit(CONNREQ_UPCALL, &ep->com.history);
1426 c4iw_put_ep(&ep->parent_ep->com);
1427 return ret;
1428 }
1429
1430 static void established_upcall(struct c4iw_ep *ep)
1431 {
1432 struct iw_cm_event event;
1433
1434 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
1435 memset(&event, 0, sizeof(event));
1436 event.event = IW_CM_EVENT_ESTABLISHED;
1437 event.ird = ep->ord;
1438 event.ord = ep->ird;
1439 if (ep->com.cm_id) {
1440 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
1441 ep->com.cm_id->event_handler(ep->com.cm_id, &event);
1442 set_bit(ESTAB_UPCALL, &ep->com.history);
1443 }
1444 }
1445
1446 static int update_rx_credits(struct c4iw_ep *ep, u32 credits)
1447 {
1448 struct cpl_rx_data_ack *req;
1449 struct sk_buff *skb;
1450 int wrlen = roundup(sizeof *req, 16);
1451
1452 PDBG("%s ep %p tid %u credits %u\n", __func__, ep, ep->hwtid, credits);
1453 skb = get_skb(NULL, wrlen, GFP_KERNEL);
1454 if (!skb) {
1455 printk(KERN_ERR MOD "update_rx_credits - cannot alloc skb!\n");
1456 return 0;
1457 }
1458
1459 /*
1460 * If we couldn't specify the entire rcv window at connection setup
1461 * due to the limit in the number of bits in the RCV_BUFSIZ field,
1462 * then add the overage in to the credits returned.
1463 */
1464 if (ep->rcv_win > RCV_BUFSIZ_M * 1024)
1465 credits += ep->rcv_win - RCV_BUFSIZ_M * 1024;
1466
1467 req = (struct cpl_rx_data_ack *) skb_put(skb, wrlen);
1468 memset(req, 0, wrlen);
1469 INIT_TP_WR(req, ep->hwtid);
1470 OPCODE_TID(req) = cpu_to_be32(MK_OPCODE_TID(CPL_RX_DATA_ACK,
1471 ep->hwtid));
1472 req->credit_dack = cpu_to_be32(credits | RX_FORCE_ACK_F |
1473 RX_DACK_CHANGE_F |
1474 RX_DACK_MODE_V(dack_mode));
1475 set_wr_txq(skb, CPL_PRIORITY_ACK, ep->ctrlq_idx);
1476 c4iw_ofld_send(&ep->com.dev->rdev, skb);
1477 return credits;
1478 }
1479
1480 #define RELAXED_IRD_NEGOTIATION 1
1481
1482 /*
1483 * process_mpa_reply - process streaming mode MPA reply
1484 *
1485 * Returns:
1486 *
1487 * 0 upon success indicating a connect request was delivered to the ULP
1488 * or the mpa request is incomplete but valid so far.
1489 *
1490 * 1 if a failure requires the caller to close the connection.
1491 *
1492 * 2 if a failure requires the caller to abort the connection.
1493 */
1494 static int process_mpa_reply(struct c4iw_ep *ep, struct sk_buff *skb)
1495 {
1496 struct mpa_message *mpa;
1497 struct mpa_v2_conn_params *mpa_v2_params;
1498 u16 plen;
1499 u16 resp_ird, resp_ord;
1500 u8 rtr_mismatch = 0, insuff_ird = 0;
1501 struct c4iw_qp_attributes attrs;
1502 enum c4iw_qp_attr_mask mask;
1503 int err;
1504 int disconnect = 0;
1505
1506 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
1507
1508 /*
1509 * If we get more than the supported amount of private data
1510 * then we must fail this connection.
1511 */
1512 if (ep->mpa_pkt_len + skb->len > sizeof(ep->mpa_pkt)) {
1513 err = -EINVAL;
1514 goto err_stop_timer;
1515 }
1516
1517 /*
1518 * copy the new data into our accumulation buffer.
1519 */
1520 skb_copy_from_linear_data(skb, &(ep->mpa_pkt[ep->mpa_pkt_len]),
1521 skb->len);
1522 ep->mpa_pkt_len += skb->len;
1523
1524 /*
1525 * if we don't even have the mpa message, then bail.
1526 */
1527 if (ep->mpa_pkt_len < sizeof(*mpa))
1528 return 0;
1529 mpa = (struct mpa_message *) ep->mpa_pkt;
1530
1531 /* Validate MPA header. */
1532 if (mpa->revision > mpa_rev) {
1533 printk(KERN_ERR MOD "%s MPA version mismatch. Local = %d,"
1534 " Received = %d\n", __func__, mpa_rev, mpa->revision);
1535 err = -EPROTO;
1536 goto err_stop_timer;
1537 }
1538 if (memcmp(mpa->key, MPA_KEY_REP, sizeof(mpa->key))) {
1539 err = -EPROTO;
1540 goto err_stop_timer;
1541 }
1542
1543 plen = ntohs(mpa->private_data_size);
1544
1545 /*
1546 * Fail if there's too much private data.
1547 */
1548 if (plen > MPA_MAX_PRIVATE_DATA) {
1549 err = -EPROTO;
1550 goto err_stop_timer;
1551 }
1552
1553 /*
1554 * If plen does not account for pkt size
1555 */
1556 if (ep->mpa_pkt_len > (sizeof(*mpa) + plen)) {
1557 err = -EPROTO;
1558 goto err_stop_timer;
1559 }
1560
1561 ep->plen = (u8) plen;
1562
1563 /*
1564 * If we don't have all the pdata yet, then bail.
1565 * We'll continue process when more data arrives.
1566 */
1567 if (ep->mpa_pkt_len < (sizeof(*mpa) + plen))
1568 return 0;
1569
1570 if (mpa->flags & MPA_REJECT) {
1571 err = -ECONNREFUSED;
1572 goto err_stop_timer;
1573 }
1574
1575 /*
1576 * Stop mpa timer. If it expired, then
1577 * we ignore the MPA reply. process_timeout()
1578 * will abort the connection.
1579 */
1580 if (stop_ep_timer(ep))
1581 return 0;
1582
1583 /*
1584 * If we get here we have accumulated the entire mpa
1585 * start reply message including private data. And
1586 * the MPA header is valid.
1587 */
1588 __state_set(&ep->com, FPDU_MODE);
1589 ep->mpa_attr.crc_enabled = (mpa->flags & MPA_CRC) | crc_enabled ? 1 : 0;
1590 ep->mpa_attr.xmit_marker_enabled = mpa->flags & MPA_MARKERS ? 1 : 0;
1591 ep->mpa_attr.version = mpa->revision;
1592 ep->mpa_attr.p2p_type = FW_RI_INIT_P2PTYPE_DISABLED;
1593
1594 if (mpa->revision == 2) {
1595 ep->mpa_attr.enhanced_rdma_conn =
1596 mpa->flags & MPA_ENHANCED_RDMA_CONN ? 1 : 0;
1597 if (ep->mpa_attr.enhanced_rdma_conn) {
1598 mpa_v2_params = (struct mpa_v2_conn_params *)
1599 (ep->mpa_pkt + sizeof(*mpa));
1600 resp_ird = ntohs(mpa_v2_params->ird) &
1601 MPA_V2_IRD_ORD_MASK;
1602 resp_ord = ntohs(mpa_v2_params->ord) &
1603 MPA_V2_IRD_ORD_MASK;
1604 PDBG("%s responder ird %u ord %u ep ird %u ord %u\n",
1605 __func__, resp_ird, resp_ord, ep->ird, ep->ord);
1606
1607 /*
1608 * This is a double-check. Ideally, below checks are
1609 * not required since ird/ord stuff has been taken
1610 * care of in c4iw_accept_cr
1611 */
1612 if (ep->ird < resp_ord) {
1613 if (RELAXED_IRD_NEGOTIATION && resp_ord <=
1614 ep->com.dev->rdev.lldi.max_ordird_qp)
1615 ep->ird = resp_ord;
1616 else
1617 insuff_ird = 1;
1618 } else if (ep->ird > resp_ord) {
1619 ep->ird = resp_ord;
1620 }
1621 if (ep->ord > resp_ird) {
1622 if (RELAXED_IRD_NEGOTIATION)
1623 ep->ord = resp_ird;
1624 else
1625 insuff_ird = 1;
1626 }
1627 if (insuff_ird) {
1628 err = -ENOMEM;
1629 ep->ird = resp_ord;
1630 ep->ord = resp_ird;
1631 }
1632
1633 if (ntohs(mpa_v2_params->ird) &
1634 MPA_V2_PEER2PEER_MODEL) {
1635 if (ntohs(mpa_v2_params->ord) &
1636 MPA_V2_RDMA_WRITE_RTR)
1637 ep->mpa_attr.p2p_type =
1638 FW_RI_INIT_P2PTYPE_RDMA_WRITE;
1639 else if (ntohs(mpa_v2_params->ord) &
1640 MPA_V2_RDMA_READ_RTR)
1641 ep->mpa_attr.p2p_type =
1642 FW_RI_INIT_P2PTYPE_READ_REQ;
1643 }
1644 }
1645 } else if (mpa->revision == 1)
1646 if (peer2peer)
1647 ep->mpa_attr.p2p_type = p2p_type;
1648
1649 PDBG("%s - crc_enabled=%d, recv_marker_enabled=%d, "
1650 "xmit_marker_enabled=%d, version=%d p2p_type=%d local-p2p_type = "
1651 "%d\n", __func__, ep->mpa_attr.crc_enabled,
1652 ep->mpa_attr.recv_marker_enabled,
1653 ep->mpa_attr.xmit_marker_enabled, ep->mpa_attr.version,
1654 ep->mpa_attr.p2p_type, p2p_type);
1655
1656 /*
1657 * If responder's RTR does not match with that of initiator, assign
1658 * FW_RI_INIT_P2PTYPE_DISABLED in mpa attributes so that RTR is not
1659 * generated when moving QP to RTS state.
1660 * A TERM message will be sent after QP has moved to RTS state
1661 */
1662 if ((ep->mpa_attr.version == 2) && peer2peer &&
1663 (ep->mpa_attr.p2p_type != p2p_type)) {
1664 ep->mpa_attr.p2p_type = FW_RI_INIT_P2PTYPE_DISABLED;
1665 rtr_mismatch = 1;
1666 }
1667
1668 attrs.mpa_attr = ep->mpa_attr;
1669 attrs.max_ird = ep->ird;
1670 attrs.max_ord = ep->ord;
1671 attrs.llp_stream_handle = ep;
1672 attrs.next_state = C4IW_QP_STATE_RTS;
1673
1674 mask = C4IW_QP_ATTR_NEXT_STATE |
1675 C4IW_QP_ATTR_LLP_STREAM_HANDLE | C4IW_QP_ATTR_MPA_ATTR |
1676 C4IW_QP_ATTR_MAX_IRD | C4IW_QP_ATTR_MAX_ORD;
1677
1678 /* bind QP and TID with INIT_WR */
1679 err = c4iw_modify_qp(ep->com.qp->rhp,
1680 ep->com.qp, mask, &attrs, 1);
1681 if (err)
1682 goto err;
1683
1684 /*
1685 * If responder's RTR requirement did not match with what initiator
1686 * supports, generate TERM message
1687 */
1688 if (rtr_mismatch) {
1689 printk(KERN_ERR "%s: RTR mismatch, sending TERM\n", __func__);
1690 attrs.layer_etype = LAYER_MPA | DDP_LLP;
1691 attrs.ecode = MPA_NOMATCH_RTR;
1692 attrs.next_state = C4IW_QP_STATE_TERMINATE;
1693 attrs.send_term = 1;
1694 err = c4iw_modify_qp(ep->com.qp->rhp, ep->com.qp,
1695 C4IW_QP_ATTR_NEXT_STATE, &attrs, 1);
1696 err = -ENOMEM;
1697 disconnect = 1;
1698 goto out;
1699 }
1700
1701 /*
1702 * Generate TERM if initiator IRD is not sufficient for responder
1703 * provided ORD. Currently, we do the same behaviour even when
1704 * responder provided IRD is also not sufficient as regards to
1705 * initiator ORD.
1706 */
1707 if (insuff_ird) {
1708 printk(KERN_ERR "%s: Insufficient IRD, sending TERM\n",
1709 __func__);
1710 attrs.layer_etype = LAYER_MPA | DDP_LLP;
1711 attrs.ecode = MPA_INSUFF_IRD;
1712 attrs.next_state = C4IW_QP_STATE_TERMINATE;
1713 attrs.send_term = 1;
1714 err = c4iw_modify_qp(ep->com.qp->rhp, ep->com.qp,
1715 C4IW_QP_ATTR_NEXT_STATE, &attrs, 1);
1716 err = -ENOMEM;
1717 disconnect = 1;
1718 goto out;
1719 }
1720 goto out;
1721 err_stop_timer:
1722 stop_ep_timer(ep);
1723 err:
1724 disconnect = 2;
1725 out:
1726 connect_reply_upcall(ep, err);
1727 return disconnect;
1728 }
1729
1730 /*
1731 * process_mpa_request - process streaming mode MPA request
1732 *
1733 * Returns:
1734 *
1735 * 0 upon success indicating a connect request was delivered to the ULP
1736 * or the mpa request is incomplete but valid so far.
1737 *
1738 * 1 if a failure requires the caller to close the connection.
1739 *
1740 * 2 if a failure requires the caller to abort the connection.
1741 */
1742 static int process_mpa_request(struct c4iw_ep *ep, struct sk_buff *skb)
1743 {
1744 struct mpa_message *mpa;
1745 struct mpa_v2_conn_params *mpa_v2_params;
1746 u16 plen;
1747
1748 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
1749
1750 /*
1751 * If we get more than the supported amount of private data
1752 * then we must fail this connection.
1753 */
1754 if (ep->mpa_pkt_len + skb->len > sizeof(ep->mpa_pkt))
1755 goto err_stop_timer;
1756
1757 PDBG("%s enter (%s line %u)\n", __func__, __FILE__, __LINE__);
1758
1759 /*
1760 * Copy the new data into our accumulation buffer.
1761 */
1762 skb_copy_from_linear_data(skb, &(ep->mpa_pkt[ep->mpa_pkt_len]),
1763 skb->len);
1764 ep->mpa_pkt_len += skb->len;
1765
1766 /*
1767 * If we don't even have the mpa message, then bail.
1768 * We'll continue process when more data arrives.
1769 */
1770 if (ep->mpa_pkt_len < sizeof(*mpa))
1771 return 0;
1772
1773 PDBG("%s enter (%s line %u)\n", __func__, __FILE__, __LINE__);
1774 mpa = (struct mpa_message *) ep->mpa_pkt;
1775
1776 /*
1777 * Validate MPA Header.
1778 */
1779 if (mpa->revision > mpa_rev) {
1780 printk(KERN_ERR MOD "%s MPA version mismatch. Local = %d,"
1781 " Received = %d\n", __func__, mpa_rev, mpa->revision);
1782 goto err_stop_timer;
1783 }
1784
1785 if (memcmp(mpa->key, MPA_KEY_REQ, sizeof(mpa->key)))
1786 goto err_stop_timer;
1787
1788 plen = ntohs(mpa->private_data_size);
1789
1790 /*
1791 * Fail if there's too much private data.
1792 */
1793 if (plen > MPA_MAX_PRIVATE_DATA)
1794 goto err_stop_timer;
1795
1796 /*
1797 * If plen does not account for pkt size
1798 */
1799 if (ep->mpa_pkt_len > (sizeof(*mpa) + plen))
1800 goto err_stop_timer;
1801 ep->plen = (u8) plen;
1802
1803 /*
1804 * If we don't have all the pdata yet, then bail.
1805 */
1806 if (ep->mpa_pkt_len < (sizeof(*mpa) + plen))
1807 return 0;
1808
1809 /*
1810 * If we get here we have accumulated the entire mpa
1811 * start reply message including private data.
1812 */
1813 ep->mpa_attr.initiator = 0;
1814 ep->mpa_attr.crc_enabled = (mpa->flags & MPA_CRC) | crc_enabled ? 1 : 0;
1815 ep->mpa_attr.recv_marker_enabled = markers_enabled;
1816 ep->mpa_attr.xmit_marker_enabled = mpa->flags & MPA_MARKERS ? 1 : 0;
1817 ep->mpa_attr.version = mpa->revision;
1818 if (mpa->revision == 1)
1819 ep->tried_with_mpa_v1 = 1;
1820 ep->mpa_attr.p2p_type = FW_RI_INIT_P2PTYPE_DISABLED;
1821
1822 if (mpa->revision == 2) {
1823 ep->mpa_attr.enhanced_rdma_conn =
1824 mpa->flags & MPA_ENHANCED_RDMA_CONN ? 1 : 0;
1825 if (ep->mpa_attr.enhanced_rdma_conn) {
1826 mpa_v2_params = (struct mpa_v2_conn_params *)
1827 (ep->mpa_pkt + sizeof(*mpa));
1828 ep->ird = ntohs(mpa_v2_params->ird) &
1829 MPA_V2_IRD_ORD_MASK;
1830 ep->ird = min_t(u32, ep->ird,
1831 cur_max_read_depth(ep->com.dev));
1832 ep->ord = ntohs(mpa_v2_params->ord) &
1833 MPA_V2_IRD_ORD_MASK;
1834 ep->ord = min_t(u32, ep->ord,
1835 cur_max_read_depth(ep->com.dev));
1836 PDBG("%s initiator ird %u ord %u\n", __func__, ep->ird,
1837 ep->ord);
1838 if (ntohs(mpa_v2_params->ird) & MPA_V2_PEER2PEER_MODEL)
1839 if (peer2peer) {
1840 if (ntohs(mpa_v2_params->ord) &
1841 MPA_V2_RDMA_WRITE_RTR)
1842 ep->mpa_attr.p2p_type =
1843 FW_RI_INIT_P2PTYPE_RDMA_WRITE;
1844 else if (ntohs(mpa_v2_params->ord) &
1845 MPA_V2_RDMA_READ_RTR)
1846 ep->mpa_attr.p2p_type =
1847 FW_RI_INIT_P2PTYPE_READ_REQ;
1848 }
1849 }
1850 } else if (mpa->revision == 1)
1851 if (peer2peer)
1852 ep->mpa_attr.p2p_type = p2p_type;
1853
1854 PDBG("%s - crc_enabled=%d, recv_marker_enabled=%d, "
1855 "xmit_marker_enabled=%d, version=%d p2p_type=%d\n", __func__,
1856 ep->mpa_attr.crc_enabled, ep->mpa_attr.recv_marker_enabled,
1857 ep->mpa_attr.xmit_marker_enabled, ep->mpa_attr.version,
1858 ep->mpa_attr.p2p_type);
1859
1860 __state_set(&ep->com, MPA_REQ_RCVD);
1861
1862 /* drive upcall */
1863 mutex_lock_nested(&ep->parent_ep->com.mutex, SINGLE_DEPTH_NESTING);
1864 if (ep->parent_ep->com.state != DEAD) {
1865 if (connect_request_upcall(ep))
1866 goto err_unlock_parent;
1867 } else {
1868 goto err_unlock_parent;
1869 }
1870 mutex_unlock(&ep->parent_ep->com.mutex);
1871 return 0;
1872
1873 err_unlock_parent:
1874 mutex_unlock(&ep->parent_ep->com.mutex);
1875 goto err_out;
1876 err_stop_timer:
1877 (void)stop_ep_timer(ep);
1878 err_out:
1879 return 2;
1880 }
1881
1882 static int rx_data(struct c4iw_dev *dev, struct sk_buff *skb)
1883 {
1884 struct c4iw_ep *ep;
1885 struct cpl_rx_data *hdr = cplhdr(skb);
1886 unsigned int dlen = ntohs(hdr->len);
1887 unsigned int tid = GET_TID(hdr);
1888 __u8 status = hdr->status;
1889 int disconnect = 0;
1890
1891 ep = get_ep_from_tid(dev, tid);
1892 if (!ep)
1893 return 0;
1894 PDBG("%s ep %p tid %u dlen %u\n", __func__, ep, ep->hwtid, dlen);
1895 skb_pull(skb, sizeof(*hdr));
1896 skb_trim(skb, dlen);
1897 mutex_lock(&ep->com.mutex);
1898
1899 /* update RX credits */
1900 update_rx_credits(ep, dlen);
1901
1902 switch (ep->com.state) {
1903 case MPA_REQ_SENT:
1904 ep->rcv_seq += dlen;
1905 disconnect = process_mpa_reply(ep, skb);
1906 break;
1907 case MPA_REQ_WAIT:
1908 ep->rcv_seq += dlen;
1909 disconnect = process_mpa_request(ep, skb);
1910 break;
1911 case FPDU_MODE: {
1912 struct c4iw_qp_attributes attrs;
1913 BUG_ON(!ep->com.qp);
1914 if (status)
1915 pr_err("%s Unexpected streaming data." \
1916 " qpid %u ep %p state %d tid %u status %d\n",
1917 __func__, ep->com.qp->wq.sq.qid, ep,
1918 ep->com.state, ep->hwtid, status);
1919 attrs.next_state = C4IW_QP_STATE_TERMINATE;
1920 c4iw_modify_qp(ep->com.qp->rhp, ep->com.qp,
1921 C4IW_QP_ATTR_NEXT_STATE, &attrs, 1);
1922 disconnect = 1;
1923 break;
1924 }
1925 default:
1926 break;
1927 }
1928 mutex_unlock(&ep->com.mutex);
1929 if (disconnect)
1930 c4iw_ep_disconnect(ep, disconnect == 2, GFP_KERNEL);
1931 c4iw_put_ep(&ep->com);
1932 return 0;
1933 }
1934
1935 static int abort_rpl(struct c4iw_dev *dev, struct sk_buff *skb)
1936 {
1937 struct c4iw_ep *ep;
1938 struct cpl_abort_rpl_rss *rpl = cplhdr(skb);
1939 int release = 0;
1940 unsigned int tid = GET_TID(rpl);
1941
1942 ep = get_ep_from_tid(dev, tid);
1943 if (!ep) {
1944 printk(KERN_WARNING MOD "Abort rpl to freed endpoint\n");
1945 return 0;
1946 }
1947 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
1948 mutex_lock(&ep->com.mutex);
1949 switch (ep->com.state) {
1950 case ABORTING:
1951 c4iw_wake_up(&ep->com.wr_wait, -ECONNRESET);
1952 __state_set(&ep->com, DEAD);
1953 release = 1;
1954 break;
1955 default:
1956 printk(KERN_ERR "%s ep %p state %d\n",
1957 __func__, ep, ep->com.state);
1958 break;
1959 }
1960 mutex_unlock(&ep->com.mutex);
1961
1962 if (release)
1963 release_ep_resources(ep);
1964 c4iw_put_ep(&ep->com);
1965 return 0;
1966 }
1967
1968 static int send_fw_act_open_req(struct c4iw_ep *ep, unsigned int atid)
1969 {
1970 struct sk_buff *skb;
1971 struct fw_ofld_connection_wr *req;
1972 unsigned int mtu_idx;
1973 int wscale;
1974 struct sockaddr_in *sin;
1975 int win;
1976
1977 skb = get_skb(NULL, sizeof(*req), GFP_KERNEL);
1978 req = (struct fw_ofld_connection_wr *)__skb_put(skb, sizeof(*req));
1979 memset(req, 0, sizeof(*req));
1980 req->op_compl = htonl(WR_OP_V(FW_OFLD_CONNECTION_WR));
1981 req->len16_pkd = htonl(FW_WR_LEN16_V(DIV_ROUND_UP(sizeof(*req), 16)));
1982 req->le.filter = cpu_to_be32(cxgb4_select_ntuple(
1983 ep->com.dev->rdev.lldi.ports[0],
1984 ep->l2t));
1985 sin = (struct sockaddr_in *)&ep->com.local_addr;
1986 req->le.lport = sin->sin_port;
1987 req->le.u.ipv4.lip = sin->sin_addr.s_addr;
1988 sin = (struct sockaddr_in *)&ep->com.remote_addr;
1989 req->le.pport = sin->sin_port;
1990 req->le.u.ipv4.pip = sin->sin_addr.s_addr;
1991 req->tcb.t_state_to_astid =
1992 htonl(FW_OFLD_CONNECTION_WR_T_STATE_V(TCP_SYN_SENT) |
1993 FW_OFLD_CONNECTION_WR_ASTID_V(atid));
1994 req->tcb.cplrxdataack_cplpassacceptrpl =
1995 htons(FW_OFLD_CONNECTION_WR_CPLRXDATAACK_F);
1996 req->tcb.tx_max = (__force __be32) jiffies;
1997 req->tcb.rcv_adv = htons(1);
1998 best_mtu(ep->com.dev->rdev.lldi.mtus, ep->mtu, &mtu_idx,
1999 enable_tcp_timestamps,
2000 (AF_INET == ep->com.remote_addr.ss_family) ? 0 : 1);
2001 wscale = compute_wscale(rcv_win);
2002
2003 /*
2004 * Specify the largest window that will fit in opt0. The
2005 * remainder will be specified in the rx_data_ack.
2006 */
2007 win = ep->rcv_win >> 10;
2008 if (win > RCV_BUFSIZ_M)
2009 win = RCV_BUFSIZ_M;
2010
2011 req->tcb.opt0 = (__force __be64) (TCAM_BYPASS_F |
2012 (nocong ? NO_CONG_F : 0) |
2013 KEEP_ALIVE_F |
2014 DELACK_F |
2015 WND_SCALE_V(wscale) |
2016 MSS_IDX_V(mtu_idx) |
2017 L2T_IDX_V(ep->l2t->idx) |
2018 TX_CHAN_V(ep->tx_chan) |
2019 SMAC_SEL_V(ep->smac_idx) |
2020 DSCP_V(ep->tos >> 2) |
2021 ULP_MODE_V(ULP_MODE_TCPDDP) |
2022 RCV_BUFSIZ_V(win));
2023 req->tcb.opt2 = (__force __be32) (PACE_V(1) |
2024 TX_QUEUE_V(ep->com.dev->rdev.lldi.tx_modq[ep->tx_chan]) |
2025 RX_CHANNEL_V(0) |
2026 CCTRL_ECN_V(enable_ecn) |
2027 RSS_QUEUE_VALID_F | RSS_QUEUE_V(ep->rss_qid));
2028 if (enable_tcp_timestamps)
2029 req->tcb.opt2 |= (__force __be32)TSTAMPS_EN_F;
2030 if (enable_tcp_sack)
2031 req->tcb.opt2 |= (__force __be32)SACK_EN_F;
2032 if (wscale && enable_tcp_window_scaling)
2033 req->tcb.opt2 |= (__force __be32)WND_SCALE_EN_F;
2034 req->tcb.opt0 = cpu_to_be64((__force u64)req->tcb.opt0);
2035 req->tcb.opt2 = cpu_to_be32((__force u32)req->tcb.opt2);
2036 set_wr_txq(skb, CPL_PRIORITY_CONTROL, ep->ctrlq_idx);
2037 set_bit(ACT_OFLD_CONN, &ep->com.history);
2038 return c4iw_l2t_send(&ep->com.dev->rdev, skb, ep->l2t);
2039 }
2040
2041 /*
2042 * Some of the error codes above implicitly indicate that there is no TID
2043 * allocated with the result of an ACT_OPEN. We use this predicate to make
2044 * that explicit.
2045 */
2046 static inline int act_open_has_tid(int status)
2047 {
2048 return (status != CPL_ERR_TCAM_PARITY &&
2049 status != CPL_ERR_TCAM_MISS &&
2050 status != CPL_ERR_TCAM_FULL &&
2051 status != CPL_ERR_CONN_EXIST_SYNRECV &&
2052 status != CPL_ERR_CONN_EXIST);
2053 }
2054
2055 /* Returns whether a CPL status conveys negative advice.
2056 */
2057 static int is_neg_adv(unsigned int status)
2058 {
2059 return status == CPL_ERR_RTX_NEG_ADVICE ||
2060 status == CPL_ERR_PERSIST_NEG_ADVICE ||
2061 status == CPL_ERR_KEEPALV_NEG_ADVICE;
2062 }
2063
2064 static char *neg_adv_str(unsigned int status)
2065 {
2066 switch (status) {
2067 case CPL_ERR_RTX_NEG_ADVICE:
2068 return "Retransmit timeout";
2069 case CPL_ERR_PERSIST_NEG_ADVICE:
2070 return "Persist timeout";
2071 case CPL_ERR_KEEPALV_NEG_ADVICE:
2072 return "Keepalive timeout";
2073 default:
2074 return "Unknown";
2075 }
2076 }
2077
2078 static void set_tcp_window(struct c4iw_ep *ep, struct port_info *pi)
2079 {
2080 ep->snd_win = snd_win;
2081 ep->rcv_win = rcv_win;
2082 PDBG("%s snd_win %d rcv_win %d\n", __func__, ep->snd_win, ep->rcv_win);
2083 }
2084
2085 #define ACT_OPEN_RETRY_COUNT 2
2086
2087 static int import_ep(struct c4iw_ep *ep, int iptype, __u8 *peer_ip,
2088 struct dst_entry *dst, struct c4iw_dev *cdev,
2089 bool clear_mpa_v1, enum chip_type adapter_type, u8 tos)
2090 {
2091 struct neighbour *n;
2092 int err, step;
2093 struct net_device *pdev;
2094
2095 n = dst_neigh_lookup(dst, peer_ip);
2096 if (!n)
2097 return -ENODEV;
2098
2099 rcu_read_lock();
2100 err = -ENOMEM;
2101 if (n->dev->flags & IFF_LOOPBACK) {
2102 if (iptype == 4)
2103 pdev = ip_dev_find(&init_net, *(__be32 *)peer_ip);
2104 else if (IS_ENABLED(CONFIG_IPV6))
2105 for_each_netdev(&init_net, pdev) {
2106 if (ipv6_chk_addr(&init_net,
2107 (struct in6_addr *)peer_ip,
2108 pdev, 1))
2109 break;
2110 }
2111 else
2112 pdev = NULL;
2113
2114 if (!pdev) {
2115 err = -ENODEV;
2116 goto out;
2117 }
2118 ep->l2t = cxgb4_l2t_get(cdev->rdev.lldi.l2t,
2119 n, pdev, rt_tos2priority(tos));
2120 if (!ep->l2t)
2121 goto out;
2122 ep->mtu = pdev->mtu;
2123 ep->tx_chan = cxgb4_port_chan(pdev);
2124 ep->smac_idx = cxgb4_tp_smt_idx(adapter_type,
2125 cxgb4_port_viid(pdev));
2126 step = cdev->rdev.lldi.ntxq /
2127 cdev->rdev.lldi.nchan;
2128 ep->txq_idx = cxgb4_port_idx(pdev) * step;
2129 step = cdev->rdev.lldi.nrxq /
2130 cdev->rdev.lldi.nchan;
2131 ep->ctrlq_idx = cxgb4_port_idx(pdev);
2132 ep->rss_qid = cdev->rdev.lldi.rxq_ids[
2133 cxgb4_port_idx(pdev) * step];
2134 set_tcp_window(ep, (struct port_info *)netdev_priv(pdev));
2135 dev_put(pdev);
2136 } else {
2137 pdev = get_real_dev(n->dev);
2138 ep->l2t = cxgb4_l2t_get(cdev->rdev.lldi.l2t,
2139 n, pdev, 0);
2140 if (!ep->l2t)
2141 goto out;
2142 ep->mtu = dst_mtu(dst);
2143 ep->tx_chan = cxgb4_port_chan(pdev);
2144 ep->smac_idx = cxgb4_tp_smt_idx(adapter_type,
2145 cxgb4_port_viid(pdev));
2146 step = cdev->rdev.lldi.ntxq /
2147 cdev->rdev.lldi.nchan;
2148 ep->txq_idx = cxgb4_port_idx(pdev) * step;
2149 ep->ctrlq_idx = cxgb4_port_idx(pdev);
2150 step = cdev->rdev.lldi.nrxq /
2151 cdev->rdev.lldi.nchan;
2152 ep->rss_qid = cdev->rdev.lldi.rxq_ids[
2153 cxgb4_port_idx(pdev) * step];
2154 set_tcp_window(ep, (struct port_info *)netdev_priv(pdev));
2155
2156 if (clear_mpa_v1) {
2157 ep->retry_with_mpa_v1 = 0;
2158 ep->tried_with_mpa_v1 = 0;
2159 }
2160 }
2161 err = 0;
2162 out:
2163 rcu_read_unlock();
2164
2165 neigh_release(n);
2166
2167 return err;
2168 }
2169
2170 static int c4iw_reconnect(struct c4iw_ep *ep)
2171 {
2172 int err = 0;
2173 int size = 0;
2174 struct sockaddr_in *laddr = (struct sockaddr_in *)
2175 &ep->com.cm_id->m_local_addr;
2176 struct sockaddr_in *raddr = (struct sockaddr_in *)
2177 &ep->com.cm_id->m_remote_addr;
2178 struct sockaddr_in6 *laddr6 = (struct sockaddr_in6 *)
2179 &ep->com.cm_id->m_local_addr;
2180 struct sockaddr_in6 *raddr6 = (struct sockaddr_in6 *)
2181 &ep->com.cm_id->m_remote_addr;
2182 int iptype;
2183 __u8 *ra;
2184
2185 PDBG("%s qp %p cm_id %p\n", __func__, ep->com.qp, ep->com.cm_id);
2186 init_timer(&ep->timer);
2187 c4iw_init_wr_wait(&ep->com.wr_wait);
2188
2189 /* When MPA revision is different on nodes, the node with MPA_rev=2
2190 * tries to reconnect with MPA_rev 1 for the same EP through
2191 * c4iw_reconnect(), where the same EP is assigned with new tid for
2192 * further connection establishment. As we are using the same EP pointer
2193 * for reconnect, few skbs are used during the previous c4iw_connect(),
2194 * which leaves the EP with inadequate skbs for further
2195 * c4iw_reconnect(), Further causing an assert BUG_ON() due to empty
2196 * skb_list() during peer_abort(). Allocate skbs which is already used.
2197 */
2198 size = (CN_MAX_CON_BUF - skb_queue_len(&ep->com.ep_skb_list));
2199 if (alloc_ep_skb_list(&ep->com.ep_skb_list, size)) {
2200 err = -ENOMEM;
2201 goto fail1;
2202 }
2203
2204 /*
2205 * Allocate an active TID to initiate a TCP connection.
2206 */
2207 ep->atid = cxgb4_alloc_atid(ep->com.dev->rdev.lldi.tids, ep);
2208 if (ep->atid == -1) {
2209 pr_err("%s - cannot alloc atid.\n", __func__);
2210 err = -ENOMEM;
2211 goto fail2;
2212 }
2213 insert_handle(ep->com.dev, &ep->com.dev->atid_idr, ep, ep->atid);
2214
2215 /* find a route */
2216 if (ep->com.cm_id->m_local_addr.ss_family == AF_INET) {
2217 ep->dst = find_route(ep->com.dev, laddr->sin_addr.s_addr,
2218 raddr->sin_addr.s_addr, laddr->sin_port,
2219 raddr->sin_port, ep->com.cm_id->tos);
2220 iptype = 4;
2221 ra = (__u8 *)&raddr->sin_addr;
2222 } else {
2223 ep->dst = find_route6(ep->com.dev, laddr6->sin6_addr.s6_addr,
2224 raddr6->sin6_addr.s6_addr,
2225 laddr6->sin6_port, raddr6->sin6_port, 0,
2226 raddr6->sin6_scope_id);
2227 iptype = 6;
2228 ra = (__u8 *)&raddr6->sin6_addr;
2229 }
2230 if (!ep->dst) {
2231 pr_err("%s - cannot find route.\n", __func__);
2232 err = -EHOSTUNREACH;
2233 goto fail3;
2234 }
2235 err = import_ep(ep, iptype, ra, ep->dst, ep->com.dev, false,
2236 ep->com.dev->rdev.lldi.adapter_type,
2237 ep->com.cm_id->tos);
2238 if (err) {
2239 pr_err("%s - cannot alloc l2e.\n", __func__);
2240 goto fail4;
2241 }
2242
2243 PDBG("%s txq_idx %u tx_chan %u smac_idx %u rss_qid %u l2t_idx %u\n",
2244 __func__, ep->txq_idx, ep->tx_chan, ep->smac_idx, ep->rss_qid,
2245 ep->l2t->idx);
2246
2247 state_set(&ep->com, CONNECTING);
2248 ep->tos = ep->com.cm_id->tos;
2249
2250 /* send connect request to rnic */
2251 err = send_connect(ep);
2252 if (!err)
2253 goto out;
2254
2255 cxgb4_l2t_release(ep->l2t);
2256 fail4:
2257 dst_release(ep->dst);
2258 fail3:
2259 remove_handle(ep->com.dev, &ep->com.dev->atid_idr, ep->atid);
2260 cxgb4_free_atid(ep->com.dev->rdev.lldi.tids, ep->atid);
2261 fail2:
2262 /*
2263 * remember to send notification to upper layer.
2264 * We are in here so the upper layer is not aware that this is
2265 * re-connect attempt and so, upper layer is still waiting for
2266 * response of 1st connect request.
2267 */
2268 connect_reply_upcall(ep, -ECONNRESET);
2269 fail1:
2270 c4iw_put_ep(&ep->com);
2271 out:
2272 return err;
2273 }
2274
2275 static int act_open_rpl(struct c4iw_dev *dev, struct sk_buff *skb)
2276 {
2277 struct c4iw_ep *ep;
2278 struct cpl_act_open_rpl *rpl = cplhdr(skb);
2279 unsigned int atid = TID_TID_G(AOPEN_ATID_G(
2280 ntohl(rpl->atid_status)));
2281 struct tid_info *t = dev->rdev.lldi.tids;
2282 int status = AOPEN_STATUS_G(ntohl(rpl->atid_status));
2283 struct sockaddr_in *la;
2284 struct sockaddr_in *ra;
2285 struct sockaddr_in6 *la6;
2286 struct sockaddr_in6 *ra6;
2287 int ret = 0;
2288
2289 ep = lookup_atid(t, atid);
2290 la = (struct sockaddr_in *)&ep->com.local_addr;
2291 ra = (struct sockaddr_in *)&ep->com.remote_addr;
2292 la6 = (struct sockaddr_in6 *)&ep->com.local_addr;
2293 ra6 = (struct sockaddr_in6 *)&ep->com.remote_addr;
2294
2295 PDBG("%s ep %p atid %u status %u errno %d\n", __func__, ep, atid,
2296 status, status2errno(status));
2297
2298 if (is_neg_adv(status)) {
2299 PDBG("%s Connection problems for atid %u status %u (%s)\n",
2300 __func__, atid, status, neg_adv_str(status));
2301 ep->stats.connect_neg_adv++;
2302 mutex_lock(&dev->rdev.stats.lock);
2303 dev->rdev.stats.neg_adv++;
2304 mutex_unlock(&dev->rdev.stats.lock);
2305 return 0;
2306 }
2307
2308 set_bit(ACT_OPEN_RPL, &ep->com.history);
2309
2310 /*
2311 * Log interesting failures.
2312 */
2313 switch (status) {
2314 case CPL_ERR_CONN_RESET:
2315 case CPL_ERR_CONN_TIMEDOUT:
2316 break;
2317 case CPL_ERR_TCAM_FULL:
2318 mutex_lock(&dev->rdev.stats.lock);
2319 dev->rdev.stats.tcam_full++;
2320 mutex_unlock(&dev->rdev.stats.lock);
2321 if (ep->com.local_addr.ss_family == AF_INET &&
2322 dev->rdev.lldi.enable_fw_ofld_conn) {
2323 ret = send_fw_act_open_req(ep, TID_TID_G(AOPEN_ATID_G(
2324 ntohl(rpl->atid_status))));
2325 if (ret)
2326 goto fail;
2327 return 0;
2328 }
2329 break;
2330 case CPL_ERR_CONN_EXIST:
2331 if (ep->retry_count++ < ACT_OPEN_RETRY_COUNT) {
2332 set_bit(ACT_RETRY_INUSE, &ep->com.history);
2333 if (ep->com.remote_addr.ss_family == AF_INET6) {
2334 struct sockaddr_in6 *sin6 =
2335 (struct sockaddr_in6 *)
2336 &ep->com.local_addr;
2337 cxgb4_clip_release(
2338 ep->com.dev->rdev.lldi.ports[0],
2339 (const u32 *)
2340 &sin6->sin6_addr.s6_addr, 1);
2341 }
2342 remove_handle(ep->com.dev, &ep->com.dev->atid_idr,
2343 atid);
2344 cxgb4_free_atid(t, atid);
2345 dst_release(ep->dst);
2346 cxgb4_l2t_release(ep->l2t);
2347 c4iw_reconnect(ep);
2348 return 0;
2349 }
2350 break;
2351 default:
2352 if (ep->com.local_addr.ss_family == AF_INET) {
2353 pr_info("Active open failure - atid %u status %u errno %d %pI4:%u->%pI4:%u\n",
2354 atid, status, status2errno(status),
2355 &la->sin_addr.s_addr, ntohs(la->sin_port),
2356 &ra->sin_addr.s_addr, ntohs(ra->sin_port));
2357 } else {
2358 pr_info("Active open failure - atid %u status %u errno %d %pI6:%u->%pI6:%u\n",
2359 atid, status, status2errno(status),
2360 la6->sin6_addr.s6_addr, ntohs(la6->sin6_port),
2361 ra6->sin6_addr.s6_addr, ntohs(ra6->sin6_port));
2362 }
2363 break;
2364 }
2365
2366 fail:
2367 connect_reply_upcall(ep, status2errno(status));
2368 state_set(&ep->com, DEAD);
2369
2370 if (ep->com.remote_addr.ss_family == AF_INET6) {
2371 struct sockaddr_in6 *sin6 =
2372 (struct sockaddr_in6 *)&ep->com.local_addr;
2373 cxgb4_clip_release(ep->com.dev->rdev.lldi.ports[0],
2374 (const u32 *)&sin6->sin6_addr.s6_addr, 1);
2375 }
2376 if (status && act_open_has_tid(status))
2377 cxgb4_remove_tid(ep->com.dev->rdev.lldi.tids, 0, GET_TID(rpl));
2378
2379 remove_handle(ep->com.dev, &ep->com.dev->atid_idr, atid);
2380 cxgb4_free_atid(t, atid);
2381 dst_release(ep->dst);
2382 cxgb4_l2t_release(ep->l2t);
2383 c4iw_put_ep(&ep->com);
2384
2385 return 0;
2386 }
2387
2388 static int pass_open_rpl(struct c4iw_dev *dev, struct sk_buff *skb)
2389 {
2390 struct cpl_pass_open_rpl *rpl = cplhdr(skb);
2391 unsigned int stid = GET_TID(rpl);
2392 struct c4iw_listen_ep *ep = get_ep_from_stid(dev, stid);
2393
2394 if (!ep) {
2395 PDBG("%s stid %d lookup failure!\n", __func__, stid);
2396 goto out;
2397 }
2398 PDBG("%s ep %p status %d error %d\n", __func__, ep,
2399 rpl->status, status2errno(rpl->status));
2400 c4iw_wake_up(&ep->com.wr_wait, status2errno(rpl->status));
2401 c4iw_put_ep(&ep->com);
2402 out:
2403 return 0;
2404 }
2405
2406 static int close_listsrv_rpl(struct c4iw_dev *dev, struct sk_buff *skb)
2407 {
2408 struct cpl_close_listsvr_rpl *rpl = cplhdr(skb);
2409 unsigned int stid = GET_TID(rpl);
2410 struct c4iw_listen_ep *ep = get_ep_from_stid(dev, stid);
2411
2412 PDBG("%s ep %p\n", __func__, ep);
2413 c4iw_wake_up(&ep->com.wr_wait, status2errno(rpl->status));
2414 c4iw_put_ep(&ep->com);
2415 return 0;
2416 }
2417
2418 static int accept_cr(struct c4iw_ep *ep, struct sk_buff *skb,
2419 struct cpl_pass_accept_req *req)
2420 {
2421 struct cpl_pass_accept_rpl *rpl;
2422 unsigned int mtu_idx;
2423 u64 opt0;
2424 u32 opt2;
2425 int wscale;
2426 struct cpl_t5_pass_accept_rpl *rpl5 = NULL;
2427 int win;
2428 enum chip_type adapter_type = ep->com.dev->rdev.lldi.adapter_type;
2429
2430 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
2431 BUG_ON(skb_cloned(skb));
2432
2433 skb_get(skb);
2434 rpl = cplhdr(skb);
2435 if (!is_t4(adapter_type)) {
2436 skb_trim(skb, roundup(sizeof(*rpl5), 16));
2437 rpl5 = (void *)rpl;
2438 INIT_TP_WR(rpl5, ep->hwtid);
2439 } else {
2440 skb_trim(skb, sizeof(*rpl));
2441 INIT_TP_WR(rpl, ep->hwtid);
2442 }
2443 OPCODE_TID(rpl) = cpu_to_be32(MK_OPCODE_TID(CPL_PASS_ACCEPT_RPL,
2444 ep->hwtid));
2445
2446 best_mtu(ep->com.dev->rdev.lldi.mtus, ep->mtu, &mtu_idx,
2447 enable_tcp_timestamps && req->tcpopt.tstamp,
2448 (AF_INET == ep->com.remote_addr.ss_family) ? 0 : 1);
2449 wscale = compute_wscale(rcv_win);
2450
2451 /*
2452 * Specify the largest window that will fit in opt0. The
2453 * remainder will be specified in the rx_data_ack.
2454 */
2455 win = ep->rcv_win >> 10;
2456 if (win > RCV_BUFSIZ_M)
2457 win = RCV_BUFSIZ_M;
2458 opt0 = (nocong ? NO_CONG_F : 0) |
2459 KEEP_ALIVE_F |
2460 DELACK_F |
2461 WND_SCALE_V(wscale) |
2462 MSS_IDX_V(mtu_idx) |
2463 L2T_IDX_V(ep->l2t->idx) |
2464 TX_CHAN_V(ep->tx_chan) |
2465 SMAC_SEL_V(ep->smac_idx) |
2466 DSCP_V(ep->tos >> 2) |
2467 ULP_MODE_V(ULP_MODE_TCPDDP) |
2468 RCV_BUFSIZ_V(win);
2469 opt2 = RX_CHANNEL_V(0) |
2470 RSS_QUEUE_VALID_F | RSS_QUEUE_V(ep->rss_qid);
2471
2472 if (enable_tcp_timestamps && req->tcpopt.tstamp)
2473 opt2 |= TSTAMPS_EN_F;
2474 if (enable_tcp_sack && req->tcpopt.sack)
2475 opt2 |= SACK_EN_F;
2476 if (wscale && enable_tcp_window_scaling)
2477 opt2 |= WND_SCALE_EN_F;
2478 if (enable_ecn) {
2479 const struct tcphdr *tcph;
2480 u32 hlen = ntohl(req->hdr_len);
2481
2482 if (CHELSIO_CHIP_VERSION(adapter_type) <= CHELSIO_T5)
2483 tcph = (const void *)(req + 1) + ETH_HDR_LEN_G(hlen) +
2484 IP_HDR_LEN_G(hlen);
2485 else
2486 tcph = (const void *)(req + 1) +
2487 T6_ETH_HDR_LEN_G(hlen) + T6_IP_HDR_LEN_G(hlen);
2488 if (tcph->ece && tcph->cwr)
2489 opt2 |= CCTRL_ECN_V(1);
2490 }
2491 if (CHELSIO_CHIP_VERSION(adapter_type) > CHELSIO_T4) {
2492 u32 isn = (prandom_u32() & ~7UL) - 1;
2493 opt2 |= T5_OPT_2_VALID_F;
2494 opt2 |= CONG_CNTRL_V(CONG_ALG_TAHOE);
2495 opt2 |= T5_ISS_F;
2496 rpl5 = (void *)rpl;
2497 memset(&rpl5->iss, 0, roundup(sizeof(*rpl5)-sizeof(*rpl), 16));
2498 if (peer2peer)
2499 isn += 4;
2500 rpl5->iss = cpu_to_be32(isn);
2501 PDBG("%s iss %u\n", __func__, be32_to_cpu(rpl5->iss));
2502 }
2503
2504 rpl->opt0 = cpu_to_be64(opt0);
2505 rpl->opt2 = cpu_to_be32(opt2);
2506 set_wr_txq(skb, CPL_PRIORITY_SETUP, ep->ctrlq_idx);
2507 t4_set_arp_err_handler(skb, ep, pass_accept_rpl_arp_failure);
2508
2509 return c4iw_l2t_send(&ep->com.dev->rdev, skb, ep->l2t);
2510 }
2511
2512 static void reject_cr(struct c4iw_dev *dev, u32 hwtid, struct sk_buff *skb)
2513 {
2514 PDBG("%s c4iw_dev %p tid %u\n", __func__, dev, hwtid);
2515 BUG_ON(skb_cloned(skb));
2516 skb_trim(skb, sizeof(struct cpl_tid_release));
2517 release_tid(&dev->rdev, hwtid, skb);
2518 return;
2519 }
2520
2521 static void get_4tuple(struct cpl_pass_accept_req *req, enum chip_type type,
2522 int *iptype, __u8 *local_ip, __u8 *peer_ip,
2523 __be16 *local_port, __be16 *peer_port)
2524 {
2525 int eth_len = (CHELSIO_CHIP_VERSION(type) <= CHELSIO_T5) ?
2526 ETH_HDR_LEN_G(be32_to_cpu(req->hdr_len)) :
2527 T6_ETH_HDR_LEN_G(be32_to_cpu(req->hdr_len));
2528 int ip_len = (CHELSIO_CHIP_VERSION(type) <= CHELSIO_T5) ?
2529 IP_HDR_LEN_G(be32_to_cpu(req->hdr_len)) :
2530 T6_IP_HDR_LEN_G(be32_to_cpu(req->hdr_len));
2531 struct iphdr *ip = (struct iphdr *)((u8 *)(req + 1) + eth_len);
2532 struct ipv6hdr *ip6 = (struct ipv6hdr *)((u8 *)(req + 1) + eth_len);
2533 struct tcphdr *tcp = (struct tcphdr *)
2534 ((u8 *)(req + 1) + eth_len + ip_len);
2535
2536 if (ip->version == 4) {
2537 PDBG("%s saddr 0x%x daddr 0x%x sport %u dport %u\n", __func__,
2538 ntohl(ip->saddr), ntohl(ip->daddr), ntohs(tcp->source),
2539 ntohs(tcp->dest));
2540 *iptype = 4;
2541 memcpy(peer_ip, &ip->saddr, 4);
2542 memcpy(local_ip, &ip->daddr, 4);
2543 } else {
2544 PDBG("%s saddr %pI6 daddr %pI6 sport %u dport %u\n", __func__,
2545 ip6->saddr.s6_addr, ip6->daddr.s6_addr, ntohs(tcp->source),
2546 ntohs(tcp->dest));
2547 *iptype = 6;
2548 memcpy(peer_ip, ip6->saddr.s6_addr, 16);
2549 memcpy(local_ip, ip6->daddr.s6_addr, 16);
2550 }
2551 *peer_port = tcp->source;
2552 *local_port = tcp->dest;
2553
2554 return;
2555 }
2556
2557 static int pass_accept_req(struct c4iw_dev *dev, struct sk_buff *skb)
2558 {
2559 struct c4iw_ep *child_ep = NULL, *parent_ep;
2560 struct cpl_pass_accept_req *req = cplhdr(skb);
2561 unsigned int stid = PASS_OPEN_TID_G(ntohl(req->tos_stid));
2562 struct tid_info *t = dev->rdev.lldi.tids;
2563 unsigned int hwtid = GET_TID(req);
2564 struct dst_entry *dst;
2565 __u8 local_ip[16], peer_ip[16];
2566 __be16 local_port, peer_port;
2567 struct sockaddr_in6 *sin6;
2568 int err;
2569 u16 peer_mss = ntohs(req->tcpopt.mss);
2570 int iptype;
2571 unsigned short hdrs;
2572 u8 tos = PASS_OPEN_TOS_G(ntohl(req->tos_stid));
2573
2574 parent_ep = (struct c4iw_ep *)get_ep_from_stid(dev, stid);
2575 if (!parent_ep) {
2576 PDBG("%s connect request on invalid stid %d\n", __func__, stid);
2577 goto reject;
2578 }
2579
2580 if (state_read(&parent_ep->com) != LISTEN) {
2581 PDBG("%s - listening ep not in LISTEN\n", __func__);
2582 goto reject;
2583 }
2584
2585 get_4tuple(req, parent_ep->com.dev->rdev.lldi.adapter_type, &iptype,
2586 local_ip, peer_ip, &local_port, &peer_port);
2587
2588 /* Find output route */
2589 if (iptype == 4) {
2590 PDBG("%s parent ep %p hwtid %u laddr %pI4 raddr %pI4 lport %d rport %d peer_mss %d\n"
2591 , __func__, parent_ep, hwtid,
2592 local_ip, peer_ip, ntohs(local_port),
2593 ntohs(peer_port), peer_mss);
2594 dst = find_route(dev, *(__be32 *)local_ip, *(__be32 *)peer_ip,
2595 local_port, peer_port,
2596 tos);
2597 } else {
2598 PDBG("%s parent ep %p hwtid %u laddr %pI6 raddr %pI6 lport %d rport %d peer_mss %d\n"
2599 , __func__, parent_ep, hwtid,
2600 local_ip, peer_ip, ntohs(local_port),
2601 ntohs(peer_port), peer_mss);
2602 dst = find_route6(dev, local_ip, peer_ip, local_port, peer_port,
2603 PASS_OPEN_TOS_G(ntohl(req->tos_stid)),
2604 ((struct sockaddr_in6 *)
2605 &parent_ep->com.local_addr)->sin6_scope_id);
2606 }
2607 if (!dst) {
2608 printk(KERN_ERR MOD "%s - failed to find dst entry!\n",
2609 __func__);
2610 goto reject;
2611 }
2612
2613 child_ep = alloc_ep(sizeof(*child_ep), GFP_KERNEL);
2614 if (!child_ep) {
2615 printk(KERN_ERR MOD "%s - failed to allocate ep entry!\n",
2616 __func__);
2617 dst_release(dst);
2618 goto reject;
2619 }
2620
2621 err = import_ep(child_ep, iptype, peer_ip, dst, dev, false,
2622 parent_ep->com.dev->rdev.lldi.adapter_type, tos);
2623 if (err) {
2624 printk(KERN_ERR MOD "%s - failed to allocate l2t entry!\n",
2625 __func__);
2626 dst_release(dst);
2627 kfree(child_ep);
2628 goto reject;
2629 }
2630
2631 hdrs = sizeof(struct iphdr) + sizeof(struct tcphdr) +
2632 ((enable_tcp_timestamps && req->tcpopt.tstamp) ? 12 : 0);
2633 if (peer_mss && child_ep->mtu > (peer_mss + hdrs))
2634 child_ep->mtu = peer_mss + hdrs;
2635
2636 skb_queue_head_init(&child_ep->com.ep_skb_list);
2637 if (alloc_ep_skb_list(&child_ep->com.ep_skb_list, CN_MAX_CON_BUF))
2638 goto fail;
2639
2640 state_set(&child_ep->com, CONNECTING);
2641 child_ep->com.dev = dev;
2642 child_ep->com.cm_id = NULL;
2643
2644 if (iptype == 4) {
2645 struct sockaddr_in *sin = (struct sockaddr_in *)
2646 &child_ep->com.local_addr;
2647
2648 sin->sin_family = PF_INET;
2649 sin->sin_port = local_port;
2650 sin->sin_addr.s_addr = *(__be32 *)local_ip;
2651
2652 sin = (struct sockaddr_in *)&child_ep->com.local_addr;
2653 sin->sin_family = PF_INET;
2654 sin->sin_port = ((struct sockaddr_in *)
2655 &parent_ep->com.local_addr)->sin_port;
2656 sin->sin_addr.s_addr = *(__be32 *)local_ip;
2657
2658 sin = (struct sockaddr_in *)&child_ep->com.remote_addr;
2659 sin->sin_family = PF_INET;
2660 sin->sin_port = peer_port;
2661 sin->sin_addr.s_addr = *(__be32 *)peer_ip;
2662 } else {
2663 sin6 = (struct sockaddr_in6 *)&child_ep->com.local_addr;
2664 sin6->sin6_family = PF_INET6;
2665 sin6->sin6_port = local_port;
2666 memcpy(sin6->sin6_addr.s6_addr, local_ip, 16);
2667
2668 sin6 = (struct sockaddr_in6 *)&child_ep->com.local_addr;
2669 sin6->sin6_family = PF_INET6;
2670 sin6->sin6_port = ((struct sockaddr_in6 *)
2671 &parent_ep->com.local_addr)->sin6_port;
2672 memcpy(sin6->sin6_addr.s6_addr, local_ip, 16);
2673
2674 sin6 = (struct sockaddr_in6 *)&child_ep->com.remote_addr;
2675 sin6->sin6_family = PF_INET6;
2676 sin6->sin6_port = peer_port;
2677 memcpy(sin6->sin6_addr.s6_addr, peer_ip, 16);
2678 }
2679
2680 c4iw_get_ep(&parent_ep->com);
2681 child_ep->parent_ep = parent_ep;
2682 child_ep->tos = tos;
2683 child_ep->dst = dst;
2684 child_ep->hwtid = hwtid;
2685
2686 PDBG("%s tx_chan %u smac_idx %u rss_qid %u\n", __func__,
2687 child_ep->tx_chan, child_ep->smac_idx, child_ep->rss_qid);
2688
2689 init_timer(&child_ep->timer);
2690 cxgb4_insert_tid(t, child_ep, hwtid);
2691 insert_ep_tid(child_ep);
2692 if (accept_cr(child_ep, skb, req)) {
2693 c4iw_put_ep(&parent_ep->com);
2694 release_ep_resources(child_ep);
2695 } else {
2696 set_bit(PASS_ACCEPT_REQ, &child_ep->com.history);
2697 }
2698 if (iptype == 6) {
2699 sin6 = (struct sockaddr_in6 *)&child_ep->com.local_addr;
2700 cxgb4_clip_get(child_ep->com.dev->rdev.lldi.ports[0],
2701 (const u32 *)&sin6->sin6_addr.s6_addr, 1);
2702 }
2703 goto out;
2704 fail:
2705 c4iw_put_ep(&child_ep->com);
2706 reject:
2707 reject_cr(dev, hwtid, skb);
2708 if (parent_ep)
2709 c4iw_put_ep(&parent_ep->com);
2710 out:
2711 return 0;
2712 }
2713
2714 static int pass_establish(struct c4iw_dev *dev, struct sk_buff *skb)
2715 {
2716 struct c4iw_ep *ep;
2717 struct cpl_pass_establish *req = cplhdr(skb);
2718 unsigned int tid = GET_TID(req);
2719 int ret;
2720
2721 ep = get_ep_from_tid(dev, tid);
2722 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
2723 ep->snd_seq = be32_to_cpu(req->snd_isn);
2724 ep->rcv_seq = be32_to_cpu(req->rcv_isn);
2725
2726 PDBG("%s ep %p hwtid %u tcp_opt 0x%02x\n", __func__, ep, tid,
2727 ntohs(req->tcp_opt));
2728
2729 set_emss(ep, ntohs(req->tcp_opt));
2730
2731 dst_confirm(ep->dst);
2732 mutex_lock(&ep->com.mutex);
2733 ep->com.state = MPA_REQ_WAIT;
2734 start_ep_timer(ep);
2735 set_bit(PASS_ESTAB, &ep->com.history);
2736 ret = send_flowc(ep);
2737 mutex_unlock(&ep->com.mutex);
2738 if (ret)
2739 c4iw_ep_disconnect(ep, 1, GFP_KERNEL);
2740 c4iw_put_ep(&ep->com);
2741
2742 return 0;
2743 }
2744
2745 static int peer_close(struct c4iw_dev *dev, struct sk_buff *skb)
2746 {
2747 struct cpl_peer_close *hdr = cplhdr(skb);
2748 struct c4iw_ep *ep;
2749 struct c4iw_qp_attributes attrs;
2750 int disconnect = 1;
2751 int release = 0;
2752 unsigned int tid = GET_TID(hdr);
2753 int ret;
2754
2755 ep = get_ep_from_tid(dev, tid);
2756 if (!ep)
2757 return 0;
2758
2759 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
2760 dst_confirm(ep->dst);
2761
2762 set_bit(PEER_CLOSE, &ep->com.history);
2763 mutex_lock(&ep->com.mutex);
2764 switch (ep->com.state) {
2765 case MPA_REQ_WAIT:
2766 __state_set(&ep->com, CLOSING);
2767 break;
2768 case MPA_REQ_SENT:
2769 __state_set(&ep->com, CLOSING);
2770 connect_reply_upcall(ep, -ECONNRESET);
2771 break;
2772 case MPA_REQ_RCVD:
2773
2774 /*
2775 * We're gonna mark this puppy DEAD, but keep
2776 * the reference on it until the ULP accepts or
2777 * rejects the CR. Also wake up anyone waiting
2778 * in rdma connection migration (see c4iw_accept_cr()).
2779 */
2780 __state_set(&ep->com, CLOSING);
2781 PDBG("waking up ep %p tid %u\n", ep, ep->hwtid);
2782 c4iw_wake_up(&ep->com.wr_wait, -ECONNRESET);
2783 break;
2784 case MPA_REP_SENT:
2785 __state_set(&ep->com, CLOSING);
2786 PDBG("waking up ep %p tid %u\n", ep, ep->hwtid);
2787 c4iw_wake_up(&ep->com.wr_wait, -ECONNRESET);
2788 break;
2789 case FPDU_MODE:
2790 start_ep_timer(ep);
2791 __state_set(&ep->com, CLOSING);
2792 attrs.next_state = C4IW_QP_STATE_CLOSING;
2793 ret = c4iw_modify_qp(ep->com.qp->rhp, ep->com.qp,
2794 C4IW_QP_ATTR_NEXT_STATE, &attrs, 1);
2795 if (ret != -ECONNRESET) {
2796 peer_close_upcall(ep);
2797 disconnect = 1;
2798 }
2799 break;
2800 case ABORTING:
2801 disconnect = 0;
2802 break;
2803 case CLOSING:
2804 __state_set(&ep->com, MORIBUND);
2805 disconnect = 0;
2806 break;
2807 case MORIBUND:
2808 (void)stop_ep_timer(ep);
2809 if (ep->com.cm_id && ep->com.qp) {
2810 attrs.next_state = C4IW_QP_STATE_IDLE;
2811 c4iw_modify_qp(ep->com.qp->rhp, ep->com.qp,
2812 C4IW_QP_ATTR_NEXT_STATE, &attrs, 1);
2813 }
2814 close_complete_upcall(ep, 0);
2815 __state_set(&ep->com, DEAD);
2816 release = 1;
2817 disconnect = 0;
2818 break;
2819 case DEAD:
2820 disconnect = 0;
2821 break;
2822 default:
2823 BUG_ON(1);
2824 }
2825 mutex_unlock(&ep->com.mutex);
2826 if (disconnect)
2827 c4iw_ep_disconnect(ep, 0, GFP_KERNEL);
2828 if (release)
2829 release_ep_resources(ep);
2830 c4iw_put_ep(&ep->com);
2831 return 0;
2832 }
2833
2834 static int peer_abort(struct c4iw_dev *dev, struct sk_buff *skb)
2835 {
2836 struct cpl_abort_req_rss *req = cplhdr(skb);
2837 struct c4iw_ep *ep;
2838 struct cpl_abort_rpl *rpl;
2839 struct sk_buff *rpl_skb;
2840 struct c4iw_qp_attributes attrs;
2841 int ret;
2842 int release = 0;
2843 unsigned int tid = GET_TID(req);
2844
2845 ep = get_ep_from_tid(dev, tid);
2846 if (!ep)
2847 return 0;
2848
2849 if (is_neg_adv(req->status)) {
2850 PDBG("%s Negative advice on abort- tid %u status %d (%s)\n",
2851 __func__, ep->hwtid, req->status,
2852 neg_adv_str(req->status));
2853 ep->stats.abort_neg_adv++;
2854 mutex_lock(&dev->rdev.stats.lock);
2855 dev->rdev.stats.neg_adv++;
2856 mutex_unlock(&dev->rdev.stats.lock);
2857 goto deref_ep;
2858 }
2859 PDBG("%s ep %p tid %u state %u\n", __func__, ep, ep->hwtid,
2860 ep->com.state);
2861 set_bit(PEER_ABORT, &ep->com.history);
2862
2863 /*
2864 * Wake up any threads in rdma_init() or rdma_fini().
2865 * However, this is not needed if com state is just
2866 * MPA_REQ_SENT
2867 */
2868 if (ep->com.state != MPA_REQ_SENT)
2869 c4iw_wake_up(&ep->com.wr_wait, -ECONNRESET);
2870
2871 mutex_lock(&ep->com.mutex);
2872 switch (ep->com.state) {
2873 case CONNECTING:
2874 c4iw_put_ep(&ep->parent_ep->com);
2875 break;
2876 case MPA_REQ_WAIT:
2877 (void)stop_ep_timer(ep);
2878 break;
2879 case MPA_REQ_SENT:
2880 (void)stop_ep_timer(ep);
2881 if (mpa_rev == 1 || (mpa_rev == 2 && ep->tried_with_mpa_v1))
2882 connect_reply_upcall(ep, -ECONNRESET);
2883 else {
2884 /*
2885 * we just don't send notification upwards because we
2886 * want to retry with mpa_v1 without upper layers even
2887 * knowing it.
2888 *
2889 * do some housekeeping so as to re-initiate the
2890 * connection
2891 */
2892 PDBG("%s: mpa_rev=%d. Retrying with mpav1\n", __func__,
2893 mpa_rev);
2894 ep->retry_with_mpa_v1 = 1;
2895 }
2896 break;
2897 case MPA_REP_SENT:
2898 break;
2899 case MPA_REQ_RCVD:
2900 break;
2901 case MORIBUND:
2902 case CLOSING:
2903 stop_ep_timer(ep);
2904 /*FALLTHROUGH*/
2905 case FPDU_MODE:
2906 if (ep->com.cm_id && ep->com.qp) {
2907 attrs.next_state = C4IW_QP_STATE_ERROR;
2908 ret = c4iw_modify_qp(ep->com.qp->rhp,
2909 ep->com.qp, C4IW_QP_ATTR_NEXT_STATE,
2910 &attrs, 1);
2911 if (ret)
2912 printk(KERN_ERR MOD
2913 "%s - qp <- error failed!\n",
2914 __func__);
2915 }
2916 peer_abort_upcall(ep);
2917 break;
2918 case ABORTING:
2919 break;
2920 case DEAD:
2921 PDBG("%s PEER_ABORT IN DEAD STATE!!!!\n", __func__);
2922 mutex_unlock(&ep->com.mutex);
2923 goto deref_ep;
2924 default:
2925 BUG_ON(1);
2926 break;
2927 }
2928 dst_confirm(ep->dst);
2929 if (ep->com.state != ABORTING) {
2930 __state_set(&ep->com, DEAD);
2931 /* we don't release if we want to retry with mpa_v1 */
2932 if (!ep->retry_with_mpa_v1)
2933 release = 1;
2934 }
2935 mutex_unlock(&ep->com.mutex);
2936
2937 rpl_skb = skb_dequeue(&ep->com.ep_skb_list);
2938 if (WARN_ON(!rpl_skb)) {
2939 release = 1;
2940 goto out;
2941 }
2942 set_wr_txq(skb, CPL_PRIORITY_DATA, ep->txq_idx);
2943 rpl = (struct cpl_abort_rpl *) skb_put(rpl_skb, sizeof(*rpl));
2944 INIT_TP_WR(rpl, ep->hwtid);
2945 OPCODE_TID(rpl) = cpu_to_be32(MK_OPCODE_TID(CPL_ABORT_RPL, ep->hwtid));
2946 rpl->cmd = CPL_ABORT_NO_RST;
2947 c4iw_ofld_send(&ep->com.dev->rdev, rpl_skb);
2948 out:
2949 if (release)
2950 release_ep_resources(ep);
2951 else if (ep->retry_with_mpa_v1) {
2952 if (ep->com.remote_addr.ss_family == AF_INET6) {
2953 struct sockaddr_in6 *sin6 =
2954 (struct sockaddr_in6 *)
2955 &ep->com.local_addr;
2956 cxgb4_clip_release(
2957 ep->com.dev->rdev.lldi.ports[0],
2958 (const u32 *)&sin6->sin6_addr.s6_addr,
2959 1);
2960 }
2961 remove_handle(ep->com.dev, &ep->com.dev->hwtid_idr, ep->hwtid);
2962 cxgb4_remove_tid(ep->com.dev->rdev.lldi.tids, 0, ep->hwtid);
2963 dst_release(ep->dst);
2964 cxgb4_l2t_release(ep->l2t);
2965 c4iw_reconnect(ep);
2966 }
2967
2968 deref_ep:
2969 c4iw_put_ep(&ep->com);
2970 /* Dereferencing ep, referenced in peer_abort_intr() */
2971 c4iw_put_ep(&ep->com);
2972 return 0;
2973 }
2974
2975 static int close_con_rpl(struct c4iw_dev *dev, struct sk_buff *skb)
2976 {
2977 struct c4iw_ep *ep;
2978 struct c4iw_qp_attributes attrs;
2979 struct cpl_close_con_rpl *rpl = cplhdr(skb);
2980 int release = 0;
2981 unsigned int tid = GET_TID(rpl);
2982
2983 ep = get_ep_from_tid(dev, tid);
2984 if (!ep)
2985 return 0;
2986
2987 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
2988 BUG_ON(!ep);
2989
2990 /* The cm_id may be null if we failed to connect */
2991 mutex_lock(&ep->com.mutex);
2992 set_bit(CLOSE_CON_RPL, &ep->com.history);
2993 switch (ep->com.state) {
2994 case CLOSING:
2995 __state_set(&ep->com, MORIBUND);
2996 break;
2997 case MORIBUND:
2998 (void)stop_ep_timer(ep);
2999 if ((ep->com.cm_id) && (ep->com.qp)) {
3000 attrs.next_state = C4IW_QP_STATE_IDLE;
3001 c4iw_modify_qp(ep->com.qp->rhp,
3002 ep->com.qp,
3003 C4IW_QP_ATTR_NEXT_STATE,
3004 &attrs, 1);
3005 }
3006 close_complete_upcall(ep, 0);
3007 __state_set(&ep->com, DEAD);
3008 release = 1;
3009 break;
3010 case ABORTING:
3011 case DEAD:
3012 break;
3013 default:
3014 BUG_ON(1);
3015 break;
3016 }
3017 mutex_unlock(&ep->com.mutex);
3018 if (release)
3019 release_ep_resources(ep);
3020 c4iw_put_ep(&ep->com);
3021 return 0;
3022 }
3023
3024 static int terminate(struct c4iw_dev *dev, struct sk_buff *skb)
3025 {
3026 struct cpl_rdma_terminate *rpl = cplhdr(skb);
3027 unsigned int tid = GET_TID(rpl);
3028 struct c4iw_ep *ep;
3029 struct c4iw_qp_attributes attrs;
3030
3031 ep = get_ep_from_tid(dev, tid);
3032 BUG_ON(!ep);
3033
3034 if (ep && ep->com.qp) {
3035 printk(KERN_WARNING MOD "TERM received tid %u qpid %u\n", tid,
3036 ep->com.qp->wq.sq.qid);
3037 attrs.next_state = C4IW_QP_STATE_TERMINATE;
3038 c4iw_modify_qp(ep->com.qp->rhp, ep->com.qp,
3039 C4IW_QP_ATTR_NEXT_STATE, &attrs, 1);
3040 } else
3041 printk(KERN_WARNING MOD "TERM received tid %u no ep/qp\n", tid);
3042 c4iw_put_ep(&ep->com);
3043
3044 return 0;
3045 }
3046
3047 /*
3048 * Upcall from the adapter indicating data has been transmitted.
3049 * For us its just the single MPA request or reply. We can now free
3050 * the skb holding the mpa message.
3051 */
3052 static int fw4_ack(struct c4iw_dev *dev, struct sk_buff *skb)
3053 {
3054 struct c4iw_ep *ep;
3055 struct cpl_fw4_ack *hdr = cplhdr(skb);
3056 u8 credits = hdr->credits;
3057 unsigned int tid = GET_TID(hdr);
3058
3059
3060 ep = get_ep_from_tid(dev, tid);
3061 if (!ep)
3062 return 0;
3063 PDBG("%s ep %p tid %u credits %u\n", __func__, ep, ep->hwtid, credits);
3064 if (credits == 0) {
3065 PDBG("%s 0 credit ack ep %p tid %u state %u\n",
3066 __func__, ep, ep->hwtid, state_read(&ep->com));
3067 goto out;
3068 }
3069
3070 dst_confirm(ep->dst);
3071 if (ep->mpa_skb) {
3072 PDBG("%s last streaming msg ack ep %p tid %u state %u "
3073 "initiator %u freeing skb\n", __func__, ep, ep->hwtid,
3074 state_read(&ep->com), ep->mpa_attr.initiator ? 1 : 0);
3075 mutex_lock(&ep->com.mutex);
3076 kfree_skb(ep->mpa_skb);
3077 ep->mpa_skb = NULL;
3078 if (test_bit(STOP_MPA_TIMER, &ep->com.flags))
3079 stop_ep_timer(ep);
3080 mutex_unlock(&ep->com.mutex);
3081 }
3082 out:
3083 c4iw_put_ep(&ep->com);
3084 return 0;
3085 }
3086
3087 int c4iw_reject_cr(struct iw_cm_id *cm_id, const void *pdata, u8 pdata_len)
3088 {
3089 int abort;
3090 struct c4iw_ep *ep = to_ep(cm_id);
3091
3092 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
3093
3094 mutex_lock(&ep->com.mutex);
3095 if (ep->com.state != MPA_REQ_RCVD) {
3096 mutex_unlock(&ep->com.mutex);
3097 c4iw_put_ep(&ep->com);
3098 return -ECONNRESET;
3099 }
3100 set_bit(ULP_REJECT, &ep->com.history);
3101 if (mpa_rev == 0)
3102 abort = 1;
3103 else
3104 abort = send_mpa_reject(ep, pdata, pdata_len);
3105 mutex_unlock(&ep->com.mutex);
3106
3107 stop_ep_timer(ep);
3108 c4iw_ep_disconnect(ep, abort != 0, GFP_KERNEL);
3109 c4iw_put_ep(&ep->com);
3110 return 0;
3111 }
3112
3113 int c4iw_accept_cr(struct iw_cm_id *cm_id, struct iw_cm_conn_param *conn_param)
3114 {
3115 int err;
3116 struct c4iw_qp_attributes attrs;
3117 enum c4iw_qp_attr_mask mask;
3118 struct c4iw_ep *ep = to_ep(cm_id);
3119 struct c4iw_dev *h = to_c4iw_dev(cm_id->device);
3120 struct c4iw_qp *qp = get_qhp(h, conn_param->qpn);
3121 int abort = 0;
3122
3123 PDBG("%s ep %p tid %u\n", __func__, ep, ep->hwtid);
3124
3125 mutex_lock(&ep->com.mutex);
3126 if (ep->com.state != MPA_REQ_RCVD) {
3127 err = -ECONNRESET;
3128 goto err_out;
3129 }
3130
3131 BUG_ON(!qp);
3132
3133 set_bit(ULP_ACCEPT, &ep->com.history);
3134 if ((conn_param->ord > cur_max_read_depth(ep->com.dev)) ||
3135 (conn_param->ird > cur_max_read_depth(ep->com.dev))) {
3136 err = -EINVAL;
3137 goto err_abort;
3138 }
3139
3140 if (ep->mpa_attr.version == 2 && ep->mpa_attr.enhanced_rdma_conn) {
3141 if (conn_param->ord > ep->ird) {
3142 if (RELAXED_IRD_NEGOTIATION) {
3143 conn_param->ord = ep->ird;
3144 } else {
3145 ep->ird = conn_param->ird;
3146 ep->ord = conn_param->ord;
3147 send_mpa_reject(ep, conn_param->private_data,
3148 conn_param->private_data_len);
3149 err = -ENOMEM;
3150 goto err_abort;
3151 }
3152 }
3153 if (conn_param->ird < ep->ord) {
3154 if (RELAXED_IRD_NEGOTIATION &&
3155 ep->ord <= h->rdev.lldi.max_ordird_qp) {
3156 conn_param->ird = ep->ord;
3157 } else {
3158 err = -ENOMEM;
3159 goto err_abort;
3160 }
3161 }
3162 }
3163 ep->ird = conn_param->ird;
3164 ep->ord = conn_param->ord;
3165
3166 if (ep->mpa_attr.version == 1) {
3167 if (peer2peer && ep->ird == 0)
3168 ep->ird = 1;
3169 } else {
3170 if (peer2peer &&
3171 (ep->mpa_attr.p2p_type != FW_RI_INIT_P2PTYPE_DISABLED) &&
3172 (p2p_type == FW_RI_INIT_P2PTYPE_READ_REQ) && ep->ird == 0)
3173 ep->ird = 1;
3174 }
3175
3176 PDBG("%s %d ird %d ord %d\n", __func__, __LINE__, ep->ird, ep->ord);
3177
3178 ep->com.cm_id = cm_id;
3179 ref_cm_id(&ep->com);
3180 ep->com.qp = qp;
3181 ref_qp(ep);
3182
3183 /* bind QP to EP and move to RTS */
3184 attrs.mpa_attr = ep->mpa_attr;
3185 attrs.max_ird = ep->ird;
3186 attrs.max_ord = ep->ord;
3187 attrs.llp_stream_handle = ep;
3188 attrs.next_state = C4IW_QP_STATE_RTS;
3189
3190 /* bind QP and TID with INIT_WR */
3191 mask = C4IW_QP_ATTR_NEXT_STATE |
3192 C4IW_QP_ATTR_LLP_STREAM_HANDLE |
3193 C4IW_QP_ATTR_MPA_ATTR |
3194 C4IW_QP_ATTR_MAX_IRD |
3195 C4IW_QP_ATTR_MAX_ORD;
3196
3197 err = c4iw_modify_qp(ep->com.qp->rhp,
3198 ep->com.qp, mask, &attrs, 1);
3199 if (err)
3200 goto err_deref_cm_id;
3201
3202 set_bit(STOP_MPA_TIMER, &ep->com.flags);
3203 err = send_mpa_reply(ep, conn_param->private_data,
3204 conn_param->private_data_len);
3205 if (err)
3206 goto err_deref_cm_id;
3207
3208 __state_set(&ep->com, FPDU_MODE);
3209 established_upcall(ep);
3210 mutex_unlock(&ep->com.mutex);
3211 c4iw_put_ep(&ep->com);
3212 return 0;
3213 err_deref_cm_id:
3214 deref_cm_id(&ep->com);
3215 err_abort:
3216 abort = 1;
3217 err_out:
3218 mutex_unlock(&ep->com.mutex);
3219 if (abort)
3220 c4iw_ep_disconnect(ep, 1, GFP_KERNEL);
3221 c4iw_put_ep(&ep->com);
3222 return err;
3223 }
3224
3225 static int pick_local_ipaddrs(struct c4iw_dev *dev, struct iw_cm_id *cm_id)
3226 {
3227 struct in_device *ind;
3228 int found = 0;
3229 struct sockaddr_in *laddr = (struct sockaddr_in *)&cm_id->m_local_addr;
3230 struct sockaddr_in *raddr = (struct sockaddr_in *)&cm_id->m_remote_addr;
3231
3232 ind = in_dev_get(dev->rdev.lldi.ports[0]);
3233 if (!ind)
3234 return -EADDRNOTAVAIL;
3235 for_primary_ifa(ind) {
3236 laddr->sin_addr.s_addr = ifa->ifa_address;
3237 raddr->sin_addr.s_addr = ifa->ifa_address;
3238 found = 1;
3239 break;
3240 }
3241 endfor_ifa(ind);
3242 in_dev_put(ind);
3243 return found ? 0 : -EADDRNOTAVAIL;
3244 }
3245
3246 static int get_lladdr(struct net_device *dev, struct in6_addr *addr,
3247 unsigned char banned_flags)
3248 {
3249 struct inet6_dev *idev;
3250 int err = -EADDRNOTAVAIL;
3251
3252 rcu_read_lock();
3253 idev = __in6_dev_get(dev);
3254 if (idev != NULL) {
3255 struct inet6_ifaddr *ifp;
3256
3257 read_lock_bh(&idev->lock);
3258 list_for_each_entry(ifp, &idev->addr_list, if_list) {
3259 if (ifp->scope == IFA_LINK &&
3260 !(ifp->flags & banned_flags)) {
3261 memcpy(addr, &ifp->addr, 16);
3262 err = 0;
3263 break;
3264 }
3265 }
3266 read_unlock_bh(&idev->lock);
3267 }
3268 rcu_read_unlock();
3269 return err;
3270 }
3271
3272 static int pick_local_ip6addrs(struct c4iw_dev *dev, struct iw_cm_id *cm_id)
3273 {
3274 struct in6_addr uninitialized_var(addr);
3275 struct sockaddr_in6 *la6 = (struct sockaddr_in6 *)&cm_id->m_local_addr;
3276 struct sockaddr_in6 *ra6 = (struct sockaddr_in6 *)&cm_id->m_remote_addr;
3277
3278 if (!get_lladdr(dev->rdev.lldi.ports[0], &addr, IFA_F_TENTATIVE)) {
3279 memcpy(la6->sin6_addr.s6_addr, &addr, 16);
3280 memcpy(ra6->sin6_addr.s6_addr, &addr, 16);
3281 return 0;
3282 }
3283 return -EADDRNOTAVAIL;
3284 }
3285
3286 int c4iw_connect(struct iw_cm_id *cm_id, struct iw_cm_conn_param *conn_param)
3287 {
3288 struct c4iw_dev *dev = to_c4iw_dev(cm_id->device);
3289 struct c4iw_ep *ep;
3290 int err = 0;
3291 struct sockaddr_in *laddr;
3292 struct sockaddr_in *raddr;
3293 struct sockaddr_in6 *laddr6;
3294 struct sockaddr_in6 *raddr6;
3295 __u8 *ra;
3296 int iptype;
3297
3298 if ((conn_param->ord > cur_max_read_depth(dev)) ||
3299 (conn_param->ird > cur_max_read_depth(dev))) {
3300 err = -EINVAL;
3301 goto out;
3302 }
3303 ep = alloc_ep(sizeof(*ep), GFP_KERNEL);
3304 if (!ep) {
3305 printk(KERN_ERR MOD "%s - cannot alloc ep.\n", __func__);
3306 err = -ENOMEM;
3307 goto out;
3308 }
3309
3310 skb_queue_head_init(&ep->com.ep_skb_list);
3311 if (alloc_ep_skb_list(&ep->com.ep_skb_list, CN_MAX_CON_BUF)) {
3312 err = -ENOMEM;
3313 goto fail1;
3314 }
3315
3316 init_timer(&ep->timer);
3317 ep->plen = conn_param->private_data_len;
3318 if (ep->plen)
3319 memcpy(ep->mpa_pkt + sizeof(struct mpa_message),
3320 conn_param->private_data, ep->plen);
3321 ep->ird = conn_param->ird;
3322 ep->ord = conn_param->ord;
3323
3324 if (peer2peer && ep->ord == 0)
3325 ep->ord = 1;
3326
3327 ep->com.cm_id = cm_id;
3328 ref_cm_id(&ep->com);
3329 ep->com.dev = dev;
3330 ep->com.qp = get_qhp(dev, conn_param->qpn);
3331 if (!ep->com.qp) {
3332 PDBG("%s qpn 0x%x not found!\n", __func__, conn_param->qpn);
3333 err = -EINVAL;
3334 goto fail2;
3335 }
3336 ref_qp(ep);
3337 PDBG("%s qpn 0x%x qp %p cm_id %p\n", __func__, conn_param->qpn,
3338 ep->com.qp, cm_id);
3339
3340 /*
3341 * Allocate an active TID to initiate a TCP connection.
3342 */
3343 ep->atid = cxgb4_alloc_atid(dev->rdev.lldi.tids, ep);
3344 if (ep->atid == -1) {
3345 printk(KERN_ERR MOD "%s - cannot alloc atid.\n", __func__);
3346 err = -ENOMEM;
3347 goto fail2;
3348 }
3349 insert_handle(dev, &dev->atid_idr, ep, ep->atid);
3350
3351 memcpy(&ep->com.local_addr, &cm_id->m_local_addr,
3352 sizeof(ep->com.local_addr));
3353 memcpy(&ep->com.remote_addr, &cm_id->m_remote_addr,
3354 sizeof(ep->com.remote_addr));
3355
3356 laddr = (struct sockaddr_in *)&ep->com.local_addr;
3357 raddr = (struct sockaddr_in *)&ep->com.remote_addr;
3358 laddr6 = (struct sockaddr_in6 *)&ep->com.local_addr;
3359 raddr6 = (struct sockaddr_in6 *) &ep->com.remote_addr;
3360
3361 if (cm_id->m_remote_addr.ss_family == AF_INET) {
3362 iptype = 4;
3363 ra = (__u8 *)&raddr->sin_addr;
3364
3365 /*
3366 * Handle loopback requests to INADDR_ANY.
3367 */
3368 if (raddr->sin_addr.s_addr == htonl(INADDR_ANY)) {
3369 err = pick_local_ipaddrs(dev, cm_id);
3370 if (err)
3371 goto fail2;
3372 }
3373
3374 /* find a route */
3375 PDBG("%s saddr %pI4 sport 0x%x raddr %pI4 rport 0x%x\n",
3376 __func__, &laddr->sin_addr, ntohs(laddr->sin_port),
3377 ra, ntohs(raddr->sin_port));
3378 ep->dst = find_route(dev, laddr->sin_addr.s_addr,
3379 raddr->sin_addr.s_addr, laddr->sin_port,
3380 raddr->sin_port, cm_id->tos);
3381 } else {
3382 iptype = 6;
3383 ra = (__u8 *)&raddr6->sin6_addr;
3384
3385 /*
3386 * Handle loopback requests to INADDR_ANY.
3387 */
3388 if (ipv6_addr_type(&raddr6->sin6_addr) == IPV6_ADDR_ANY) {
3389 err = pick_local_ip6addrs(dev, cm_id);
3390 if (err)
3391 goto fail2;
3392 }
3393
3394 /* find a route */
3395 PDBG("%s saddr %pI6 sport 0x%x raddr %pI6 rport 0x%x\n",
3396 __func__, laddr6->sin6_addr.s6_addr,
3397 ntohs(laddr6->sin6_port),
3398 raddr6->sin6_addr.s6_addr, ntohs(raddr6->sin6_port));
3399 ep->dst = find_route6(dev, laddr6->sin6_addr.s6_addr,
3400 raddr6->sin6_addr.s6_addr,
3401 laddr6->sin6_port, raddr6->sin6_port, 0,
3402 raddr6->sin6_scope_id);
3403 }
3404 if (!ep->dst) {
3405 printk(KERN_ERR MOD "%s - cannot find route.\n", __func__);
3406 err = -EHOSTUNREACH;
3407 goto fail3;
3408 }
3409
3410 err = import_ep(ep, iptype, ra, ep->dst, ep->com.dev, true,
3411 ep->com.dev->rdev.lldi.adapter_type, cm_id->tos);
3412 if (err) {
3413 printk(KERN_ERR MOD "%s - cannot alloc l2e.\n", __func__);
3414 goto fail4;
3415 }
3416
3417 PDBG("%s txq_idx %u tx_chan %u smac_idx %u rss_qid %u l2t_idx %u\n",
3418 __func__, ep->txq_idx, ep->tx_chan, ep->smac_idx, ep->rss_qid,
3419 ep->l2t->idx);
3420
3421 state_set(&ep->com, CONNECTING);
3422 ep->tos = cm_id->tos;
3423
3424 /* send connect request to rnic */
3425 err = send_connect(ep);
3426 if (!err)
3427 goto out;
3428
3429 cxgb4_l2t_release(ep->l2t);
3430 fail4:
3431 dst_release(ep->dst);
3432 fail3:
3433 remove_handle(ep->com.dev, &ep->com.dev->atid_idr, ep->atid);
3434 cxgb4_free_atid(ep->com.dev->rdev.lldi.tids, ep->atid);
3435 fail2:
3436 skb_queue_purge(&ep->com.ep_skb_list);
3437 deref_cm_id(&ep->com);
3438 fail1:
3439 c4iw_put_ep(&ep->com);
3440 out:
3441 return err;
3442 }
3443
3444 static int create_server6(struct c4iw_dev *dev, struct c4iw_listen_ep *ep)
3445 {
3446 int err;
3447 struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)
3448 &ep->com.local_addr;
3449
3450 if (ipv6_addr_type(&sin6->sin6_addr) != IPV6_ADDR_ANY) {
3451 err = cxgb4_clip_get(ep->com.dev->rdev.lldi.ports[0],
3452 (const u32 *)&sin6->sin6_addr.s6_addr, 1);
3453 if (err)
3454 return err;
3455 }
3456 c4iw_init_wr_wait(&ep->com.wr_wait);
3457 err = cxgb4_create_server6(ep->com.dev->rdev.lldi.ports[0],
3458 ep->stid, &sin6->sin6_addr,
3459 sin6->sin6_port,
3460 ep->com.dev->rdev.lldi.rxq_ids[0]);
3461 if (!err)
3462 err = c4iw_wait_for_reply(&ep->com.dev->rdev,
3463 &ep->com.wr_wait,
3464 0, 0, __func__);
3465 else if (err > 0)
3466 err = net_xmit_errno(err);
3467 if (err) {
3468 cxgb4_clip_release(ep->com.dev->rdev.lldi.ports[0],
3469 (const u32 *)&sin6->sin6_addr.s6_addr, 1);
3470 pr_err("cxgb4_create_server6/filter failed err %d stid %d laddr %pI6 lport %d\n",
3471 err, ep->stid,
3472 sin6->sin6_addr.s6_addr, ntohs(sin6->sin6_port));
3473 }
3474 return err;
3475 }
3476
3477 static int create_server4(struct c4iw_dev *dev, struct c4iw_listen_ep *ep)
3478 {
3479 int err;
3480 struct sockaddr_in *sin = (struct sockaddr_in *)
3481 &ep->com.local_addr;
3482
3483 if (dev->rdev.lldi.enable_fw_ofld_conn) {
3484 do {
3485 err = cxgb4_create_server_filter(
3486 ep->com.dev->rdev.lldi.ports[0], ep->stid,
3487 sin->sin_addr.s_addr, sin->sin_port, 0,
3488 ep->com.dev->rdev.lldi.rxq_ids[0], 0, 0);
3489 if (err == -EBUSY) {
3490 if (c4iw_fatal_error(&ep->com.dev->rdev)) {
3491 err = -EIO;
3492 break;
3493 }
3494 set_current_state(TASK_UNINTERRUPTIBLE);
3495 schedule_timeout(usecs_to_jiffies(100));
3496 }
3497 } while (err == -EBUSY);
3498 } else {
3499 c4iw_init_wr_wait(&ep->com.wr_wait);
3500 err = cxgb4_create_server(ep->com.dev->rdev.lldi.ports[0],
3501 ep->stid, sin->sin_addr.s_addr, sin->sin_port,
3502 0, ep->com.dev->rdev.lldi.rxq_ids[0]);
3503 if (!err)
3504 err = c4iw_wait_for_reply(&ep->com.dev->rdev,
3505 &ep->com.wr_wait,
3506 0, 0, __func__);
3507 else if (err > 0)
3508 err = net_xmit_errno(err);
3509 }
3510 if (err)
3511 pr_err("cxgb4_create_server/filter failed err %d stid %d laddr %pI4 lport %d\n"
3512 , err, ep->stid,
3513 &sin->sin_addr, ntohs(sin->sin_port));
3514 return err;
3515 }
3516
3517 int c4iw_create_listen(struct iw_cm_id *cm_id, int backlog)
3518 {
3519 int err = 0;
3520 struct c4iw_dev *dev = to_c4iw_dev(cm_id->device);
3521 struct c4iw_listen_ep *ep;
3522
3523 might_sleep();
3524
3525 ep = alloc_ep(sizeof(*ep), GFP_KERNEL);
3526 if (!ep) {
3527 printk(KERN_ERR MOD "%s - cannot alloc ep.\n", __func__);
3528 err = -ENOMEM;
3529 goto fail1;
3530 }
3531 skb_queue_head_init(&ep->com.ep_skb_list);
3532 PDBG("%s ep %p\n", __func__, ep);
3533 ep->com.cm_id = cm_id;
3534 ref_cm_id(&ep->com);
3535 ep->com.dev = dev;
3536 ep->backlog = backlog;
3537 memcpy(&ep->com.local_addr, &cm_id->m_local_addr,
3538 sizeof(ep->com.local_addr));
3539
3540 /*
3541 * Allocate a server TID.
3542 */
3543 if (dev->rdev.lldi.enable_fw_ofld_conn &&
3544 ep->com.local_addr.ss_family == AF_INET)
3545 ep->stid = cxgb4_alloc_sftid(dev->rdev.lldi.tids,
3546 cm_id->m_local_addr.ss_family, ep);
3547 else
3548 ep->stid = cxgb4_alloc_stid(dev->rdev.lldi.tids,
3549 cm_id->m_local_addr.ss_family, ep);
3550
3551 if (ep->stid == -1) {
3552 printk(KERN_ERR MOD "%s - cannot alloc stid.\n", __func__);
3553 err = -ENOMEM;
3554 goto fail2;
3555 }
3556 insert_handle(dev, &dev->stid_idr, ep, ep->stid);
3557
3558 memcpy(&ep->com.local_addr, &cm_id->m_local_addr,
3559 sizeof(ep->com.local_addr));
3560
3561 state_set(&ep->com, LISTEN);
3562 if (ep->com.local_addr.ss_family == AF_INET)
3563 err = create_server4(dev, ep);
3564 else
3565 err = create_server6(dev, ep);
3566 if (!err) {
3567 cm_id->provider_data = ep;
3568 goto out;
3569 }
3570
3571 cxgb4_free_stid(ep->com.dev->rdev.lldi.tids, ep->stid,
3572 ep->com.local_addr.ss_family);
3573 fail2:
3574 deref_cm_id(&ep->com);
3575 c4iw_put_ep(&ep->com);
3576 fail1:
3577 out:
3578 return err;
3579 }
3580
3581 int c4iw_destroy_listen(struct iw_cm_id *cm_id)
3582 {
3583 int err;
3584 struct c4iw_listen_ep *ep = to_listen_ep(cm_id);
3585
3586 PDBG("%s ep %p\n", __func__, ep);
3587
3588 might_sleep();
3589 state_set(&ep->com, DEAD);
3590 if (ep->com.dev->rdev.lldi.enable_fw_ofld_conn &&
3591 ep->com.local_addr.ss_family == AF_INET) {
3592 err = cxgb4_remove_server_filter(
3593 ep->com.dev->rdev.lldi.ports[0], ep->stid,
3594 ep->com.dev->rdev.lldi.rxq_ids[0], 0);
3595 } else {
3596 struct sockaddr_in6 *sin6;
3597 c4iw_init_wr_wait(&ep->com.wr_wait);
3598 err = cxgb4_remove_server(
3599 ep->com.dev->rdev.lldi.ports[0], ep->stid,
3600 ep->com.dev->rdev.lldi.rxq_ids[0], 0);
3601 if (err)
3602 goto done;
3603 err = c4iw_wait_for_reply(&ep->com.dev->rdev, &ep->com.wr_wait,
3604 0, 0, __func__);
3605 sin6 = (struct sockaddr_in6 *)&ep->com.local_addr;
3606 cxgb4_clip_release(ep->com.dev->rdev.lldi.ports[0],
3607 (const u32 *)&sin6->sin6_addr.s6_addr, 1);
3608 }
3609 remove_handle(ep->com.dev, &ep->com.dev->stid_idr, ep->stid);
3610 cxgb4_free_stid(ep->com.dev->rdev.lldi.tids, ep->stid,
3611 ep->com.local_addr.ss_family);
3612 done:
3613 deref_cm_id(&ep->com);
3614 c4iw_put_ep(&ep->com);
3615 return err;
3616 }
3617
3618 int c4iw_ep_disconnect(struct c4iw_ep *ep, int abrupt, gfp_t gfp)
3619 {
3620 int ret = 0;
3621 int close = 0;
3622 int fatal = 0;
3623 struct c4iw_rdev *rdev;
3624
3625 mutex_lock(&ep->com.mutex);
3626
3627 PDBG("%s ep %p state %s, abrupt %d\n", __func__, ep,
3628 states[ep->com.state], abrupt);
3629
3630 /*
3631 * Ref the ep here in case we have fatal errors causing the
3632 * ep to be released and freed.
3633 */
3634 c4iw_get_ep(&ep->com);
3635
3636 rdev = &ep->com.dev->rdev;
3637 if (c4iw_fatal_error(rdev)) {
3638 fatal = 1;
3639 close_complete_upcall(ep, -EIO);
3640 ep->com.state = DEAD;
3641 }
3642 switch (ep->com.state) {
3643 case MPA_REQ_WAIT:
3644 case MPA_REQ_SENT:
3645 case MPA_REQ_RCVD:
3646 case MPA_REP_SENT:
3647 case FPDU_MODE:
3648 case CONNECTING:
3649 close = 1;
3650 if (abrupt)
3651 ep->com.state = ABORTING;
3652 else {
3653 ep->com.state = CLOSING;
3654
3655 /*
3656 * if we close before we see the fw4_ack() then we fix
3657 * up the timer state since we're reusing it.
3658 */
3659 if (ep->mpa_skb &&
3660 test_bit(STOP_MPA_TIMER, &ep->com.flags)) {
3661 clear_bit(STOP_MPA_TIMER, &ep->com.flags);
3662 stop_ep_timer(ep);
3663 }
3664 start_ep_timer(ep);
3665 }
3666 set_bit(CLOSE_SENT, &ep->com.flags);
3667 break;
3668 case CLOSING:
3669 if (!test_and_set_bit(CLOSE_SENT, &ep->com.flags)) {
3670 close = 1;
3671 if (abrupt) {
3672 (void)stop_ep_timer(ep);
3673 ep->com.state = ABORTING;
3674 } else
3675 ep->com.state = MORIBUND;
3676 }
3677 break;
3678 case MORIBUND:
3679 case ABORTING:
3680 case DEAD:
3681 PDBG("%s ignoring disconnect ep %p state %u\n",
3682 __func__, ep, ep->com.state);
3683 break;
3684 default:
3685 BUG();
3686 break;
3687 }
3688
3689 if (close) {
3690 if (abrupt) {
3691 set_bit(EP_DISC_ABORT, &ep->com.history);
3692 close_complete_upcall(ep, -ECONNRESET);
3693 ret = send_abort(ep);
3694 } else {
3695 set_bit(EP_DISC_CLOSE, &ep->com.history);
3696 ret = send_halfclose(ep);
3697 }
3698 if (ret) {
3699 set_bit(EP_DISC_FAIL, &ep->com.history);
3700 if (!abrupt) {
3701 stop_ep_timer(ep);
3702 close_complete_upcall(ep, -EIO);
3703 }
3704 if (ep->com.qp) {
3705 struct c4iw_qp_attributes attrs;
3706
3707 attrs.next_state = C4IW_QP_STATE_ERROR;
3708 ret = c4iw_modify_qp(ep->com.qp->rhp,
3709 ep->com.qp,
3710 C4IW_QP_ATTR_NEXT_STATE,
3711 &attrs, 1);
3712 if (ret)
3713 pr_err(MOD
3714 "%s - qp <- error failed!\n",
3715 __func__);
3716 }
3717 fatal = 1;
3718 }
3719 }
3720 mutex_unlock(&ep->com.mutex);
3721 c4iw_put_ep(&ep->com);
3722 if (fatal)
3723 release_ep_resources(ep);
3724 return ret;
3725 }
3726
3727 static void active_ofld_conn_reply(struct c4iw_dev *dev, struct sk_buff *skb,
3728 struct cpl_fw6_msg_ofld_connection_wr_rpl *req)
3729 {
3730 struct c4iw_ep *ep;
3731 int atid = be32_to_cpu(req->tid);
3732
3733 ep = (struct c4iw_ep *)lookup_atid(dev->rdev.lldi.tids,
3734 (__force u32) req->tid);
3735 if (!ep)
3736 return;
3737
3738 switch (req->retval) {
3739 case FW_ENOMEM:
3740 set_bit(ACT_RETRY_NOMEM, &ep->com.history);
3741 if (ep->retry_count++ < ACT_OPEN_RETRY_COUNT) {
3742 send_fw_act_open_req(ep, atid);
3743 return;
3744 }
3745 case FW_EADDRINUSE:
3746 set_bit(ACT_RETRY_INUSE, &ep->com.history);
3747 if (ep->retry_count++ < ACT_OPEN_RETRY_COUNT) {
3748 send_fw_act_open_req(ep, atid);
3749 return;
3750 }
3751 break;
3752 default:
3753 pr_info("%s unexpected ofld conn wr retval %d\n",
3754 __func__, req->retval);
3755 break;
3756 }
3757 pr_err("active ofld_connect_wr failure %d atid %d\n",
3758 req->retval, atid);
3759 mutex_lock(&dev->rdev.stats.lock);
3760 dev->rdev.stats.act_ofld_conn_fails++;
3761 mutex_unlock(&dev->rdev.stats.lock);
3762 connect_reply_upcall(ep, status2errno(req->retval));
3763 state_set(&ep->com, DEAD);
3764 if (ep->com.remote_addr.ss_family == AF_INET6) {
3765 struct sockaddr_in6 *sin6 =
3766 (struct sockaddr_in6 *)&ep->com.local_addr;
3767 cxgb4_clip_release(ep->com.dev->rdev.lldi.ports[0],
3768 (const u32 *)&sin6->sin6_addr.s6_addr, 1);
3769 }
3770 remove_handle(dev, &dev->atid_idr, atid);
3771 cxgb4_free_atid(dev->rdev.lldi.tids, atid);
3772 dst_release(ep->dst);
3773 cxgb4_l2t_release(ep->l2t);
3774 c4iw_put_ep(&ep->com);
3775 }
3776
3777 static void passive_ofld_conn_reply(struct c4iw_dev *dev, struct sk_buff *skb,
3778 struct cpl_fw6_msg_ofld_connection_wr_rpl *req)
3779 {
3780 struct sk_buff *rpl_skb;
3781 struct cpl_pass_accept_req *cpl;
3782 int ret;
3783
3784 rpl_skb = (struct sk_buff *)(unsigned long)req->cookie;
3785 BUG_ON(!rpl_skb);
3786 if (req->retval) {
3787 PDBG("%s passive open failure %d\n", __func__, req->retval);
3788 mutex_lock(&dev->rdev.stats.lock);
3789 dev->rdev.stats.pas_ofld_conn_fails++;
3790 mutex_unlock(&dev->rdev.stats.lock);
3791 kfree_skb(rpl_skb);
3792 } else {
3793 cpl = (struct cpl_pass_accept_req *)cplhdr(rpl_skb);
3794 OPCODE_TID(cpl) = htonl(MK_OPCODE_TID(CPL_PASS_ACCEPT_REQ,
3795 (__force u32) htonl(
3796 (__force u32) req->tid)));
3797 ret = pass_accept_req(dev, rpl_skb);
3798 if (!ret)
3799 kfree_skb(rpl_skb);
3800 }
3801 return;
3802 }
3803
3804 static int deferred_fw6_msg(struct c4iw_dev *dev, struct sk_buff *skb)
3805 {
3806 struct cpl_fw6_msg *rpl = cplhdr(skb);
3807 struct cpl_fw6_msg_ofld_connection_wr_rpl *req;
3808
3809 switch (rpl->type) {
3810 case FW6_TYPE_CQE:
3811 c4iw_ev_dispatch(dev, (struct t4_cqe *)&rpl->data[0]);
3812 break;
3813 case FW6_TYPE_OFLD_CONNECTION_WR_RPL:
3814 req = (struct cpl_fw6_msg_ofld_connection_wr_rpl *)rpl->data;
3815 switch (req->t_state) {
3816 case TCP_SYN_SENT:
3817 active_ofld_conn_reply(dev, skb, req);
3818 break;
3819 case TCP_SYN_RECV:
3820 passive_ofld_conn_reply(dev, skb, req);
3821 break;
3822 default:
3823 pr_err("%s unexpected ofld conn wr state %d\n",
3824 __func__, req->t_state);
3825 break;
3826 }
3827 break;
3828 }
3829 return 0;
3830 }
3831
3832 static void build_cpl_pass_accept_req(struct sk_buff *skb, int stid , u8 tos)
3833 {
3834 __be32 l2info;
3835 __be16 hdr_len, vlantag, len;
3836 u16 eth_hdr_len;
3837 int tcp_hdr_len, ip_hdr_len;
3838 u8 intf;
3839 struct cpl_rx_pkt *cpl = cplhdr(skb);
3840 struct cpl_pass_accept_req *req;
3841 struct tcp_options_received tmp_opt;
3842 struct c4iw_dev *dev;
3843 enum chip_type type;
3844
3845 dev = *((struct c4iw_dev **) (skb->cb + sizeof(void *)));
3846 /* Store values from cpl_rx_pkt in temporary location. */
3847 vlantag = cpl->vlan;
3848 len = cpl->len;
3849 l2info = cpl->l2info;
3850 hdr_len = cpl->hdr_len;
3851 intf = cpl->iff;
3852
3853 __skb_pull(skb, sizeof(*req) + sizeof(struct rss_header));
3854
3855 /*
3856 * We need to parse the TCP options from SYN packet.
3857 * to generate cpl_pass_accept_req.
3858 */
3859 memset(&tmp_opt, 0, sizeof(tmp_opt));
3860 tcp_clear_options(&tmp_opt);
3861 tcp_parse_options(skb, &tmp_opt, 0, NULL);
3862
3863 req = (struct cpl_pass_accept_req *)__skb_push(skb, sizeof(*req));
3864 memset(req, 0, sizeof(*req));
3865 req->l2info = cpu_to_be16(SYN_INTF_V(intf) |
3866 SYN_MAC_IDX_V(RX_MACIDX_G(
3867 be32_to_cpu(l2info))) |
3868 SYN_XACT_MATCH_F);
3869 type = dev->rdev.lldi.adapter_type;
3870 tcp_hdr_len = RX_TCPHDR_LEN_G(be16_to_cpu(hdr_len));
3871 ip_hdr_len = RX_IPHDR_LEN_G(be16_to_cpu(hdr_len));
3872 req->hdr_len =
3873 cpu_to_be32(SYN_RX_CHAN_V(RX_CHAN_G(be32_to_cpu(l2info))));
3874 if (CHELSIO_CHIP_VERSION(type) <= CHELSIO_T5) {
3875 eth_hdr_len = is_t4(type) ?
3876 RX_ETHHDR_LEN_G(be32_to_cpu(l2info)) :
3877 RX_T5_ETHHDR_LEN_G(be32_to_cpu(l2info));
3878 req->hdr_len |= cpu_to_be32(TCP_HDR_LEN_V(tcp_hdr_len) |
3879 IP_HDR_LEN_V(ip_hdr_len) |
3880 ETH_HDR_LEN_V(eth_hdr_len));
3881 } else { /* T6 and later */
3882 eth_hdr_len = RX_T6_ETHHDR_LEN_G(be32_to_cpu(l2info));
3883 req->hdr_len |= cpu_to_be32(T6_TCP_HDR_LEN_V(tcp_hdr_len) |
3884 T6_IP_HDR_LEN_V(ip_hdr_len) |
3885 T6_ETH_HDR_LEN_V(eth_hdr_len));
3886 }
3887 req->vlan = vlantag;
3888 req->len = len;
3889 req->tos_stid = cpu_to_be32(PASS_OPEN_TID_V(stid) |
3890 PASS_OPEN_TOS_V(tos));
3891 req->tcpopt.mss = htons(tmp_opt.mss_clamp);
3892 if (tmp_opt.wscale_ok)
3893 req->tcpopt.wsf = tmp_opt.snd_wscale;
3894 req->tcpopt.tstamp = tmp_opt.saw_tstamp;
3895 if (tmp_opt.sack_ok)
3896 req->tcpopt.sack = 1;
3897 OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_PASS_ACCEPT_REQ, 0));
3898 return;
3899 }
3900
3901 static void send_fw_pass_open_req(struct c4iw_dev *dev, struct sk_buff *skb,
3902 __be32 laddr, __be16 lport,
3903 __be32 raddr, __be16 rport,
3904 u32 rcv_isn, u32 filter, u16 window,
3905 u32 rss_qid, u8 port_id)
3906 {
3907 struct sk_buff *req_skb;
3908 struct fw_ofld_connection_wr *req;
3909 struct cpl_pass_accept_req *cpl = cplhdr(skb);
3910 int ret;
3911
3912 req_skb = alloc_skb(sizeof(struct fw_ofld_connection_wr), GFP_KERNEL);
3913 req = (struct fw_ofld_connection_wr *)__skb_put(req_skb, sizeof(*req));
3914 memset(req, 0, sizeof(*req));
3915 req->op_compl = htonl(WR_OP_V(FW_OFLD_CONNECTION_WR) | FW_WR_COMPL_F);
3916 req->len16_pkd = htonl(FW_WR_LEN16_V(DIV_ROUND_UP(sizeof(*req), 16)));
3917 req->le.version_cpl = htonl(FW_OFLD_CONNECTION_WR_CPL_F);
3918 req->le.filter = (__force __be32) filter;
3919 req->le.lport = lport;
3920 req->le.pport = rport;
3921 req->le.u.ipv4.lip = laddr;
3922 req->le.u.ipv4.pip = raddr;
3923 req->tcb.rcv_nxt = htonl(rcv_isn + 1);
3924 req->tcb.rcv_adv = htons(window);
3925 req->tcb.t_state_to_astid =
3926 htonl(FW_OFLD_CONNECTION_WR_T_STATE_V(TCP_SYN_RECV) |
3927 FW_OFLD_CONNECTION_WR_RCV_SCALE_V(cpl->tcpopt.wsf) |
3928 FW_OFLD_CONNECTION_WR_ASTID_V(
3929 PASS_OPEN_TID_G(ntohl(cpl->tos_stid))));
3930
3931 /*
3932 * We store the qid in opt2 which will be used by the firmware
3933 * to send us the wr response.
3934 */
3935 req->tcb.opt2 = htonl(RSS_QUEUE_V(rss_qid));
3936
3937 /*
3938 * We initialize the MSS index in TCB to 0xF.
3939 * So that when driver sends cpl_pass_accept_rpl
3940 * TCB picks up the correct value. If this was 0
3941 * TP will ignore any value > 0 for MSS index.
3942 */
3943 req->tcb.opt0 = cpu_to_be64(MSS_IDX_V(0xF));
3944 req->cookie = (uintptr_t)skb;
3945
3946 set_wr_txq(req_skb, CPL_PRIORITY_CONTROL, port_id);
3947 ret = cxgb4_ofld_send(dev->rdev.lldi.ports[0], req_skb);
3948 if (ret < 0) {
3949 pr_err("%s - cxgb4_ofld_send error %d - dropping\n", __func__,
3950 ret);
3951 kfree_skb(skb);
3952 kfree_skb(req_skb);
3953 }
3954 }
3955
3956 /*
3957 * Handler for CPL_RX_PKT message. Need to handle cpl_rx_pkt
3958 * messages when a filter is being used instead of server to
3959 * redirect a syn packet. When packets hit filter they are redirected
3960 * to the offload queue and driver tries to establish the connection
3961 * using firmware work request.
3962 */
3963 static int rx_pkt(struct c4iw_dev *dev, struct sk_buff *skb)
3964 {
3965 int stid;
3966 unsigned int filter;
3967 struct ethhdr *eh = NULL;
3968 struct vlan_ethhdr *vlan_eh = NULL;
3969 struct iphdr *iph;
3970 struct tcphdr *tcph;
3971 struct rss_header *rss = (void *)skb->data;
3972 struct cpl_rx_pkt *cpl = (void *)skb->data;
3973 struct cpl_pass_accept_req *req = (void *)(rss + 1);
3974 struct l2t_entry *e;
3975 struct dst_entry *dst;
3976 struct c4iw_ep *lep = NULL;
3977 u16 window;
3978 struct port_info *pi;
3979 struct net_device *pdev;
3980 u16 rss_qid, eth_hdr_len;
3981 int step;
3982 u32 tx_chan;
3983 struct neighbour *neigh;
3984
3985 /* Drop all non-SYN packets */
3986 if (!(cpl->l2info & cpu_to_be32(RXF_SYN_F)))
3987 goto reject;
3988
3989 /*
3990 * Drop all packets which did not hit the filter.
3991 * Unlikely to happen.
3992 */
3993 if (!(rss->filter_hit && rss->filter_tid))
3994 goto reject;
3995
3996 /*
3997 * Calculate the server tid from filter hit index from cpl_rx_pkt.
3998 */
3999 stid = (__force int) cpu_to_be32((__force u32) rss->hash_val);
4000
4001 lep = (struct c4iw_ep *)get_ep_from_stid(dev, stid);
4002 if (!lep) {
4003 PDBG("%s connect request on invalid stid %d\n", __func__, stid);
4004 goto reject;
4005 }
4006
4007 switch (CHELSIO_CHIP_VERSION(dev->rdev.lldi.adapter_type)) {
4008 case CHELSIO_T4:
4009 eth_hdr_len = RX_ETHHDR_LEN_G(be32_to_cpu(cpl->l2info));
4010 break;
4011 case CHELSIO_T5:
4012 eth_hdr_len = RX_T5_ETHHDR_LEN_G(be32_to_cpu(cpl->l2info));
4013 break;
4014 case CHELSIO_T6:
4015 eth_hdr_len = RX_T6_ETHHDR_LEN_G(be32_to_cpu(cpl->l2info));
4016 break;
4017 default:
4018 pr_err("T%d Chip is not supported\n",
4019 CHELSIO_CHIP_VERSION(dev->rdev.lldi.adapter_type));
4020 goto reject;
4021 }
4022
4023 if (eth_hdr_len == ETH_HLEN) {
4024 eh = (struct ethhdr *)(req + 1);
4025 iph = (struct iphdr *)(eh + 1);
4026 } else {
4027 vlan_eh = (struct vlan_ethhdr *)(req + 1);
4028 iph = (struct iphdr *)(vlan_eh + 1);
4029 skb->vlan_tci = ntohs(cpl->vlan);
4030 }
4031
4032 if (iph->version != 0x4)
4033 goto reject;
4034
4035 tcph = (struct tcphdr *)(iph + 1);
4036 skb_set_network_header(skb, (void *)iph - (void *)rss);
4037 skb_set_transport_header(skb, (void *)tcph - (void *)rss);
4038 skb_get(skb);
4039
4040 PDBG("%s lip 0x%x lport %u pip 0x%x pport %u tos %d\n", __func__,
4041 ntohl(iph->daddr), ntohs(tcph->dest), ntohl(iph->saddr),
4042 ntohs(tcph->source), iph->tos);
4043
4044 dst = find_route(dev, iph->daddr, iph->saddr, tcph->dest, tcph->source,
4045 iph->tos);
4046 if (!dst) {
4047 pr_err("%s - failed to find dst entry!\n",
4048 __func__);
4049 goto reject;
4050 }
4051 neigh = dst_neigh_lookup_skb(dst, skb);
4052
4053 if (!neigh) {
4054 pr_err("%s - failed to allocate neigh!\n",
4055 __func__);
4056 goto free_dst;
4057 }
4058
4059 if (neigh->dev->flags & IFF_LOOPBACK) {
4060 pdev = ip_dev_find(&init_net, iph->daddr);
4061 e = cxgb4_l2t_get(dev->rdev.lldi.l2t, neigh,
4062 pdev, 0);
4063 pi = (struct port_info *)netdev_priv(pdev);
4064 tx_chan = cxgb4_port_chan(pdev);
4065 dev_put(pdev);
4066 } else {
4067 pdev = get_real_dev(neigh->dev);
4068 e = cxgb4_l2t_get(dev->rdev.lldi.l2t, neigh,
4069 pdev, 0);
4070 pi = (struct port_info *)netdev_priv(pdev);
4071 tx_chan = cxgb4_port_chan(pdev);
4072 }
4073 neigh_release(neigh);
4074 if (!e) {
4075 pr_err("%s - failed to allocate l2t entry!\n",
4076 __func__);
4077 goto free_dst;
4078 }
4079
4080 step = dev->rdev.lldi.nrxq / dev->rdev.lldi.nchan;
4081 rss_qid = dev->rdev.lldi.rxq_ids[pi->port_id * step];
4082 window = (__force u16) htons((__force u16)tcph->window);
4083
4084 /* Calcuate filter portion for LE region. */
4085 filter = (__force unsigned int) cpu_to_be32(cxgb4_select_ntuple(
4086 dev->rdev.lldi.ports[0],
4087 e));
4088
4089 /*
4090 * Synthesize the cpl_pass_accept_req. We have everything except the
4091 * TID. Once firmware sends a reply with TID we update the TID field
4092 * in cpl and pass it through the regular cpl_pass_accept_req path.
4093 */
4094 build_cpl_pass_accept_req(skb, stid, iph->tos);
4095 send_fw_pass_open_req(dev, skb, iph->daddr, tcph->dest, iph->saddr,
4096 tcph->source, ntohl(tcph->seq), filter, window,
4097 rss_qid, pi->port_id);
4098 cxgb4_l2t_release(e);
4099 free_dst:
4100 dst_release(dst);
4101 reject:
4102 if (lep)
4103 c4iw_put_ep(&lep->com);
4104 return 0;
4105 }
4106
4107 /*
4108 * These are the real handlers that are called from a
4109 * work queue.
4110 */
4111 static c4iw_handler_func work_handlers[NUM_CPL_CMDS + NUM_FAKE_CPLS] = {
4112 [CPL_ACT_ESTABLISH] = act_establish,
4113 [CPL_ACT_OPEN_RPL] = act_open_rpl,
4114 [CPL_RX_DATA] = rx_data,
4115 [CPL_ABORT_RPL_RSS] = abort_rpl,
4116 [CPL_ABORT_RPL] = abort_rpl,
4117 [CPL_PASS_OPEN_RPL] = pass_open_rpl,
4118 [CPL_CLOSE_LISTSRV_RPL] = close_listsrv_rpl,
4119 [CPL_PASS_ACCEPT_REQ] = pass_accept_req,
4120 [CPL_PASS_ESTABLISH] = pass_establish,
4121 [CPL_PEER_CLOSE] = peer_close,
4122 [CPL_ABORT_REQ_RSS] = peer_abort,
4123 [CPL_CLOSE_CON_RPL] = close_con_rpl,
4124 [CPL_RDMA_TERMINATE] = terminate,
4125 [CPL_FW4_ACK] = fw4_ack,
4126 [CPL_FW6_MSG] = deferred_fw6_msg,
4127 [CPL_RX_PKT] = rx_pkt,
4128 [FAKE_CPL_PUT_EP_SAFE] = _put_ep_safe,
4129 [FAKE_CPL_PASS_PUT_EP_SAFE] = _put_pass_ep_safe
4130 };
4131
4132 static void process_timeout(struct c4iw_ep *ep)
4133 {
4134 struct c4iw_qp_attributes attrs;
4135 int abort = 1;
4136
4137 mutex_lock(&ep->com.mutex);
4138 PDBG("%s ep %p tid %u state %d\n", __func__, ep, ep->hwtid,
4139 ep->com.state);
4140 set_bit(TIMEDOUT, &ep->com.history);
4141 switch (ep->com.state) {
4142 case MPA_REQ_SENT:
4143 connect_reply_upcall(ep, -ETIMEDOUT);
4144 break;
4145 case MPA_REQ_WAIT:
4146 case MPA_REQ_RCVD:
4147 case MPA_REP_SENT:
4148 case FPDU_MODE:
4149 break;
4150 case CLOSING:
4151 case MORIBUND:
4152 if (ep->com.cm_id && ep->com.qp) {
4153 attrs.next_state = C4IW_QP_STATE_ERROR;
4154 c4iw_modify_qp(ep->com.qp->rhp,
4155 ep->com.qp, C4IW_QP_ATTR_NEXT_STATE,
4156 &attrs, 1);
4157 }
4158 close_complete_upcall(ep, -ETIMEDOUT);
4159 break;
4160 case ABORTING:
4161 case DEAD:
4162
4163 /*
4164 * These states are expected if the ep timed out at the same
4165 * time as another thread was calling stop_ep_timer().
4166 * So we silently do nothing for these states.
4167 */
4168 abort = 0;
4169 break;
4170 default:
4171 WARN(1, "%s unexpected state ep %p tid %u state %u\n",
4172 __func__, ep, ep->hwtid, ep->com.state);
4173 abort = 0;
4174 }
4175 mutex_unlock(&ep->com.mutex);
4176 if (abort)
4177 c4iw_ep_disconnect(ep, 1, GFP_KERNEL);
4178 c4iw_put_ep(&ep->com);
4179 }
4180
4181 static void process_timedout_eps(void)
4182 {
4183 struct c4iw_ep *ep;
4184
4185 spin_lock_irq(&timeout_lock);
4186 while (!list_empty(&timeout_list)) {
4187 struct list_head *tmp;
4188
4189 tmp = timeout_list.next;
4190 list_del(tmp);
4191 tmp->next = NULL;
4192 tmp->prev = NULL;
4193 spin_unlock_irq(&timeout_lock);
4194 ep = list_entry(tmp, struct c4iw_ep, entry);
4195 process_timeout(ep);
4196 spin_lock_irq(&timeout_lock);
4197 }
4198 spin_unlock_irq(&timeout_lock);
4199 }
4200
4201 static void process_work(struct work_struct *work)
4202 {
4203 struct sk_buff *skb = NULL;
4204 struct c4iw_dev *dev;
4205 struct cpl_act_establish *rpl;
4206 unsigned int opcode;
4207 int ret;
4208
4209 process_timedout_eps();
4210 while ((skb = skb_dequeue(&rxq))) {
4211 rpl = cplhdr(skb);
4212 dev = *((struct c4iw_dev **) (skb->cb + sizeof(void *)));
4213 opcode = rpl->ot.opcode;
4214
4215 BUG_ON(!work_handlers[opcode]);
4216 ret = work_handlers[opcode](dev, skb);
4217 if (!ret)
4218 kfree_skb(skb);
4219 process_timedout_eps();
4220 }
4221 }
4222
4223 static DECLARE_WORK(skb_work, process_work);
4224
4225 static void ep_timeout(unsigned long arg)
4226 {
4227 struct c4iw_ep *ep = (struct c4iw_ep *)arg;
4228 int kickit = 0;
4229
4230 spin_lock(&timeout_lock);
4231 if (!test_and_set_bit(TIMEOUT, &ep->com.flags)) {
4232 /*
4233 * Only insert if it is not already on the list.
4234 */
4235 if (!ep->entry.next) {
4236 list_add_tail(&ep->entry, &timeout_list);
4237 kickit = 1;
4238 }
4239 }
4240 spin_unlock(&timeout_lock);
4241 if (kickit)
4242 queue_work(workq, &skb_work);
4243 }
4244
4245 /*
4246 * All the CM events are handled on a work queue to have a safe context.
4247 */
4248 static int sched(struct c4iw_dev *dev, struct sk_buff *skb)
4249 {
4250
4251 /*
4252 * Save dev in the skb->cb area.
4253 */
4254 *((struct c4iw_dev **) (skb->cb + sizeof(void *))) = dev;
4255
4256 /*
4257 * Queue the skb and schedule the worker thread.
4258 */
4259 skb_queue_tail(&rxq, skb);
4260 queue_work(workq, &skb_work);
4261 return 0;
4262 }
4263
4264 static int set_tcb_rpl(struct c4iw_dev *dev, struct sk_buff *skb)
4265 {
4266 struct cpl_set_tcb_rpl *rpl = cplhdr(skb);
4267
4268 if (rpl->status != CPL_ERR_NONE) {
4269 printk(KERN_ERR MOD "Unexpected SET_TCB_RPL status %u "
4270 "for tid %u\n", rpl->status, GET_TID(rpl));
4271 }
4272 kfree_skb(skb);
4273 return 0;
4274 }
4275
4276 static int fw6_msg(struct c4iw_dev *dev, struct sk_buff *skb)
4277 {
4278 struct cpl_fw6_msg *rpl = cplhdr(skb);
4279 struct c4iw_wr_wait *wr_waitp;
4280 int ret;
4281
4282 PDBG("%s type %u\n", __func__, rpl->type);
4283
4284 switch (rpl->type) {
4285 case FW6_TYPE_WR_RPL:
4286 ret = (int)((be64_to_cpu(rpl->data[0]) >> 8) & 0xff);
4287 wr_waitp = (struct c4iw_wr_wait *)(__force unsigned long) rpl->data[1];
4288 PDBG("%s wr_waitp %p ret %u\n", __func__, wr_waitp, ret);
4289 if (wr_waitp)
4290 c4iw_wake_up(wr_waitp, ret ? -ret : 0);
4291 kfree_skb(skb);
4292 break;
4293 case FW6_TYPE_CQE:
4294 case FW6_TYPE_OFLD_CONNECTION_WR_RPL:
4295 sched(dev, skb);
4296 break;
4297 default:
4298 printk(KERN_ERR MOD "%s unexpected fw6 msg type %u\n", __func__,
4299 rpl->type);
4300 kfree_skb(skb);
4301 break;
4302 }
4303 return 0;
4304 }
4305
4306 static int peer_abort_intr(struct c4iw_dev *dev, struct sk_buff *skb)
4307 {
4308 struct cpl_abort_req_rss *req = cplhdr(skb);
4309 struct c4iw_ep *ep;
4310 unsigned int tid = GET_TID(req);
4311
4312 ep = get_ep_from_tid(dev, tid);
4313 /* This EP will be dereferenced in peer_abort() */
4314 if (!ep) {
4315 printk(KERN_WARNING MOD
4316 "Abort on non-existent endpoint, tid %d\n", tid);
4317 kfree_skb(skb);
4318 return 0;
4319 }
4320 if (is_neg_adv(req->status)) {
4321 PDBG("%s Negative advice on abort- tid %u status %d (%s)\n",
4322 __func__, ep->hwtid, req->status,
4323 neg_adv_str(req->status));
4324 goto out;
4325 }
4326 PDBG("%s ep %p tid %u state %u\n", __func__, ep, ep->hwtid,
4327 ep->com.state);
4328
4329 c4iw_wake_up(&ep->com.wr_wait, -ECONNRESET);
4330 out:
4331 sched(dev, skb);
4332 return 0;
4333 }
4334
4335 /*
4336 * Most upcalls from the T4 Core go to sched() to
4337 * schedule the processing on a work queue.
4338 */
4339 c4iw_handler_func c4iw_handlers[NUM_CPL_CMDS] = {
4340 [CPL_ACT_ESTABLISH] = sched,
4341 [CPL_ACT_OPEN_RPL] = sched,
4342 [CPL_RX_DATA] = sched,
4343 [CPL_ABORT_RPL_RSS] = sched,
4344 [CPL_ABORT_RPL] = sched,
4345 [CPL_PASS_OPEN_RPL] = sched,
4346 [CPL_CLOSE_LISTSRV_RPL] = sched,
4347 [CPL_PASS_ACCEPT_REQ] = sched,
4348 [CPL_PASS_ESTABLISH] = sched,
4349 [CPL_PEER_CLOSE] = sched,
4350 [CPL_CLOSE_CON_RPL] = sched,
4351 [CPL_ABORT_REQ_RSS] = peer_abort_intr,
4352 [CPL_RDMA_TERMINATE] = sched,
4353 [CPL_FW4_ACK] = sched,
4354 [CPL_SET_TCB_RPL] = set_tcb_rpl,
4355 [CPL_FW6_MSG] = fw6_msg,
4356 [CPL_RX_PKT] = sched
4357 };
4358
4359 int __init c4iw_cm_init(void)
4360 {
4361 spin_lock_init(&timeout_lock);
4362 skb_queue_head_init(&rxq);
4363
4364 workq = create_singlethread_workqueue("iw_cxgb4");
4365 if (!workq)
4366 return -ENOMEM;
4367
4368 return 0;
4369 }
4370
4371 void c4iw_cm_term(void)
4372 {
4373 WARN_ON(!list_empty(&timeout_list));
4374 flush_workqueue(workq);
4375 destroy_workqueue(workq);
4376 }
Linux kernel - Deliverables
This page took 0.188856 seconds and 5 git commands to generate.