1 /*
2  * Copyright (c) 2016 Chelsio Communications, Inc.
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License version 2 as
6  * published by the Free Software Foundation.
7  */
8 
9 #include <linux/module.h>
10 #include <linux/list.h>
11 #include <linux/workqueue.h>
12 #include <linux/skbuff.h>
13 #include <linux/timer.h>
14 #include <linux/notifier.h>
15 #include <linux/inetdevice.h>
16 #include <linux/ip.h>
17 #include <linux/tcp.h>
18 #include <linux/if_vlan.h>
19 
20 #include <net/neighbour.h>
21 #include <net/netevent.h>
22 #include <net/route.h>
23 #include <net/tcp.h>
24 #include <net/ip6_route.h>
25 #include <net/addrconf.h>
26 
27 #include <libcxgb_cm.h>
28 #include "cxgbit.h"
29 #include "clip_tbl.h"
30 
31 static void cxgbit_init_wr_wait(struct cxgbit_wr_wait *wr_waitp)
32 {
33 	wr_waitp->ret = 0;
34 	reinit_completion(&wr_waitp->completion);
35 }
36 
37 static void
38 cxgbit_wake_up(struct cxgbit_wr_wait *wr_waitp, const char *func, u8 ret)
39 {
40 	if (ret == CPL_ERR_NONE)
41 		wr_waitp->ret = 0;
42 	else
43 		wr_waitp->ret = -EIO;
44 
45 	if (wr_waitp->ret)
46 		pr_err("%s: err:%u", func, ret);
47 
48 	complete(&wr_waitp->completion);
49 }
50 
51 static int
52 cxgbit_wait_for_reply(struct cxgbit_device *cdev,
53 		      struct cxgbit_wr_wait *wr_waitp, u32 tid, u32 timeout,
54 		      const char *func)
55 {
56 	int ret;
57 
58 	if (!test_bit(CDEV_STATE_UP, &cdev->flags)) {
59 		wr_waitp->ret = -EIO;
60 		goto out;
61 	}
62 
63 	ret = wait_for_completion_timeout(&wr_waitp->completion, timeout * HZ);
64 	if (!ret) {
65 		pr_info("%s - Device %s not responding tid %u\n",
66 			func, pci_name(cdev->lldi.pdev), tid);
67 		wr_waitp->ret = -ETIMEDOUT;
68 	}
69 out:
70 	if (wr_waitp->ret)
71 		pr_info("%s: FW reply %d tid %u\n",
72 			pci_name(cdev->lldi.pdev), wr_waitp->ret, tid);
73 	return wr_waitp->ret;
74 }
75 
76 static int cxgbit_np_hashfn(const struct cxgbit_np *cnp)
77 {
78 	return ((unsigned long)cnp >> 10) & (NP_INFO_HASH_SIZE - 1);
79 }
80 
81 static struct np_info *
82 cxgbit_np_hash_add(struct cxgbit_device *cdev, struct cxgbit_np *cnp,
83 		   unsigned int stid)
84 {
85 	struct np_info *p = kzalloc(sizeof(*p), GFP_KERNEL);
86 
87 	if (p) {
88 		int bucket = cxgbit_np_hashfn(cnp);
89 
90 		p->cnp = cnp;
91 		p->stid = stid;
92 		spin_lock(&cdev->np_lock);
93 		p->next = cdev->np_hash_tab[bucket];
94 		cdev->np_hash_tab[bucket] = p;
95 		spin_unlock(&cdev->np_lock);
96 	}
97 
98 	return p;
99 }
100 
101 static int
102 cxgbit_np_hash_find(struct cxgbit_device *cdev, struct cxgbit_np *cnp)
103 {
104 	int stid = -1, bucket = cxgbit_np_hashfn(cnp);
105 	struct np_info *p;
106 
107 	spin_lock(&cdev->np_lock);
108 	for (p = cdev->np_hash_tab[bucket]; p; p = p->next) {
109 		if (p->cnp == cnp) {
110 			stid = p->stid;
111 			break;
112 		}
113 	}
114 	spin_unlock(&cdev->np_lock);
115 
116 	return stid;
117 }
118 
119 static int cxgbit_np_hash_del(struct cxgbit_device *cdev, struct cxgbit_np *cnp)
120 {
121 	int stid = -1, bucket = cxgbit_np_hashfn(cnp);
122 	struct np_info *p, **prev = &cdev->np_hash_tab[bucket];
123 
124 	spin_lock(&cdev->np_lock);
125 	for (p = *prev; p; prev = &p->next, p = p->next) {
126 		if (p->cnp == cnp) {
127 			stid = p->stid;
128 			*prev = p->next;
129 			kfree(p);
130 			break;
131 		}
132 	}
133 	spin_unlock(&cdev->np_lock);
134 
135 	return stid;
136 }
137 
138 void _cxgbit_free_cnp(struct kref *kref)
139 {
140 	struct cxgbit_np *cnp;
141 
142 	cnp = container_of(kref, struct cxgbit_np, kref);
143 	kfree(cnp);
144 }
145 
146 static int
147 cxgbit_create_server6(struct cxgbit_device *cdev, unsigned int stid,
148 		      struct cxgbit_np *cnp)
149 {
150 	struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)
151 				     &cnp->com.local_addr;
152 	int addr_type;
153 	int ret;
154 
155 	pr_debug("%s: dev = %s; stid = %u; sin6_port = %u\n",
156 		 __func__, cdev->lldi.ports[0]->name, stid, sin6->sin6_port);
157 
158 	addr_type = ipv6_addr_type((const struct in6_addr *)
159 				   &sin6->sin6_addr);
160 	if (addr_type != IPV6_ADDR_ANY) {
161 		ret = cxgb4_clip_get(cdev->lldi.ports[0],
162 				     (const u32 *)&sin6->sin6_addr.s6_addr, 1);
163 		if (ret) {
164 			pr_err("Unable to find clip table entry. laddr %pI6. Error:%d.\n",
165 			       sin6->sin6_addr.s6_addr, ret);
166 			return -ENOMEM;
167 		}
168 	}
169 
170 	cxgbit_get_cnp(cnp);
171 	cxgbit_init_wr_wait(&cnp->com.wr_wait);
172 
173 	ret = cxgb4_create_server6(cdev->lldi.ports[0],
174 				   stid, &sin6->sin6_addr,
175 				   sin6->sin6_port,
176 				   cdev->lldi.rxq_ids[0]);
177 	if (!ret)
178 		ret = cxgbit_wait_for_reply(cdev, &cnp->com.wr_wait,
179 					    0, 10, __func__);
180 	else if (ret > 0)
181 		ret = net_xmit_errno(ret);
182 	else
183 		cxgbit_put_cnp(cnp);
184 
185 	if (ret) {
186 		if (ret != -ETIMEDOUT)
187 			cxgb4_clip_release(cdev->lldi.ports[0],
188 				   (const u32 *)&sin6->sin6_addr.s6_addr, 1);
189 
190 		pr_err("create server6 err %d stid %d laddr %pI6 lport %d\n",
191 		       ret, stid, sin6->sin6_addr.s6_addr,
192 		       ntohs(sin6->sin6_port));
193 	}
194 
195 	return ret;
196 }
197 
198 static int
199 cxgbit_create_server4(struct cxgbit_device *cdev, unsigned int stid,
200 		      struct cxgbit_np *cnp)
201 {
202 	struct sockaddr_in *sin = (struct sockaddr_in *)
203 				   &cnp->com.local_addr;
204 	int ret;
205 
206 	pr_debug("%s: dev = %s; stid = %u; sin_port = %u\n",
207 		 __func__, cdev->lldi.ports[0]->name, stid, sin->sin_port);
208 
209 	cxgbit_get_cnp(cnp);
210 	cxgbit_init_wr_wait(&cnp->com.wr_wait);
211 
212 	ret = cxgb4_create_server(cdev->lldi.ports[0],
213 				  stid, sin->sin_addr.s_addr,
214 				  sin->sin_port, 0,
215 				  cdev->lldi.rxq_ids[0]);
216 	if (!ret)
217 		ret = cxgbit_wait_for_reply(cdev,
218 					    &cnp->com.wr_wait,
219 					    0, 10, __func__);
220 	else if (ret > 0)
221 		ret = net_xmit_errno(ret);
222 	else
223 		cxgbit_put_cnp(cnp);
224 
225 	if (ret)
226 		pr_err("create server failed err %d stid %d laddr %pI4 lport %d\n",
227 		       ret, stid, &sin->sin_addr, ntohs(sin->sin_port));
228 	return ret;
229 }
230 
231 struct cxgbit_device *cxgbit_find_device(struct net_device *ndev, u8 *port_id)
232 {
233 	struct cxgbit_device *cdev;
234 	u8 i;
235 
236 	list_for_each_entry(cdev, &cdev_list_head, list) {
237 		struct cxgb4_lld_info *lldi = &cdev->lldi;
238 
239 		for (i = 0; i < lldi->nports; i++) {
240 			if (lldi->ports[i] == ndev) {
241 				if (port_id)
242 					*port_id = i;
243 				return cdev;
244 			}
245 		}
246 	}
247 
248 	return NULL;
249 }
250 
251 static struct net_device *cxgbit_get_real_dev(struct net_device *ndev)
252 {
253 	if (ndev->priv_flags & IFF_BONDING) {
254 		pr_err("Bond devices are not supported. Interface:%s\n",
255 		       ndev->name);
256 		return NULL;
257 	}
258 
259 	if (is_vlan_dev(ndev))
260 		return vlan_dev_real_dev(ndev);
261 
262 	return ndev;
263 }
264 
265 static struct net_device *cxgbit_ipv4_netdev(__be32 saddr)
266 {
267 	struct net_device *ndev;
268 
269 	ndev = __ip_dev_find(&init_net, saddr, false);
270 	if (!ndev)
271 		return NULL;
272 
273 	return cxgbit_get_real_dev(ndev);
274 }
275 
276 static struct net_device *cxgbit_ipv6_netdev(struct in6_addr *addr6)
277 {
278 	struct net_device *ndev = NULL;
279 	bool found = false;
280 
281 	if (IS_ENABLED(CONFIG_IPV6)) {
282 		for_each_netdev_rcu(&init_net, ndev)
283 			if (ipv6_chk_addr(&init_net, addr6, ndev, 1)) {
284 				found = true;
285 				break;
286 			}
287 	}
288 	if (!found)
289 		return NULL;
290 	return cxgbit_get_real_dev(ndev);
291 }
292 
293 static struct cxgbit_device *cxgbit_find_np_cdev(struct cxgbit_np *cnp)
294 {
295 	struct sockaddr_storage *sockaddr = &cnp->com.local_addr;
296 	int ss_family = sockaddr->ss_family;
297 	struct net_device *ndev = NULL;
298 	struct cxgbit_device *cdev = NULL;
299 
300 	rcu_read_lock();
301 	if (ss_family == AF_INET) {
302 		struct sockaddr_in *sin;
303 
304 		sin = (struct sockaddr_in *)sockaddr;
305 		ndev = cxgbit_ipv4_netdev(sin->sin_addr.s_addr);
306 	} else if (ss_family == AF_INET6) {
307 		struct sockaddr_in6 *sin6;
308 
309 		sin6 = (struct sockaddr_in6 *)sockaddr;
310 		ndev = cxgbit_ipv6_netdev(&sin6->sin6_addr);
311 	}
312 	if (!ndev)
313 		goto out;
314 
315 	cdev = cxgbit_find_device(ndev, NULL);
316 out:
317 	rcu_read_unlock();
318 	return cdev;
319 }
320 
321 static bool cxgbit_inaddr_any(struct cxgbit_np *cnp)
322 {
323 	struct sockaddr_storage *sockaddr = &cnp->com.local_addr;
324 	int ss_family = sockaddr->ss_family;
325 	int addr_type;
326 
327 	if (ss_family == AF_INET) {
328 		struct sockaddr_in *sin;
329 
330 		sin = (struct sockaddr_in *)sockaddr;
331 		if (sin->sin_addr.s_addr == htonl(INADDR_ANY))
332 			return true;
333 	} else if (ss_family == AF_INET6) {
334 		struct sockaddr_in6 *sin6;
335 
336 		sin6 = (struct sockaddr_in6 *)sockaddr;
337 		addr_type = ipv6_addr_type((const struct in6_addr *)
338 				&sin6->sin6_addr);
339 		if (addr_type == IPV6_ADDR_ANY)
340 			return true;
341 	}
342 	return false;
343 }
344 
345 static int
346 __cxgbit_setup_cdev_np(struct cxgbit_device *cdev, struct cxgbit_np *cnp)
347 {
348 	int stid, ret;
349 	int ss_family = cnp->com.local_addr.ss_family;
350 
351 	if (!test_bit(CDEV_STATE_UP, &cdev->flags))
352 		return -EINVAL;
353 
354 	stid = cxgb4_alloc_stid(cdev->lldi.tids, ss_family, cnp);
355 	if (stid < 0)
356 		return -EINVAL;
357 
358 	if (!cxgbit_np_hash_add(cdev, cnp, stid)) {
359 		cxgb4_free_stid(cdev->lldi.tids, stid, ss_family);
360 		return -EINVAL;
361 	}
362 
363 	if (ss_family == AF_INET)
364 		ret = cxgbit_create_server4(cdev, stid, cnp);
365 	else
366 		ret = cxgbit_create_server6(cdev, stid, cnp);
367 
368 	if (ret) {
369 		if (ret != -ETIMEDOUT)
370 			cxgb4_free_stid(cdev->lldi.tids, stid,
371 					ss_family);
372 		cxgbit_np_hash_del(cdev, cnp);
373 		return ret;
374 	}
375 	return ret;
376 }
377 
378 static int cxgbit_setup_cdev_np(struct cxgbit_np *cnp)
379 {
380 	struct cxgbit_device *cdev;
381 	int ret = -1;
382 
383 	mutex_lock(&cdev_list_lock);
384 	cdev = cxgbit_find_np_cdev(cnp);
385 	if (!cdev)
386 		goto out;
387 
388 	if (cxgbit_np_hash_find(cdev, cnp) >= 0)
389 		goto out;
390 
391 	if (__cxgbit_setup_cdev_np(cdev, cnp))
392 		goto out;
393 
394 	cnp->com.cdev = cdev;
395 	ret = 0;
396 out:
397 	mutex_unlock(&cdev_list_lock);
398 	return ret;
399 }
400 
401 static int cxgbit_setup_all_np(struct cxgbit_np *cnp)
402 {
403 	struct cxgbit_device *cdev;
404 	int ret;
405 	u32 count = 0;
406 
407 	mutex_lock(&cdev_list_lock);
408 	list_for_each_entry(cdev, &cdev_list_head, list) {
409 		if (cxgbit_np_hash_find(cdev, cnp) >= 0) {
410 			mutex_unlock(&cdev_list_lock);
411 			return -1;
412 		}
413 	}
414 
415 	list_for_each_entry(cdev, &cdev_list_head, list) {
416 		ret = __cxgbit_setup_cdev_np(cdev, cnp);
417 		if (ret == -ETIMEDOUT)
418 			break;
419 		if (ret != 0)
420 			continue;
421 		count++;
422 	}
423 	mutex_unlock(&cdev_list_lock);
424 
425 	return count ? 0 : -1;
426 }
427 
428 int cxgbit_setup_np(struct iscsi_np *np, struct sockaddr_storage *ksockaddr)
429 {
430 	struct cxgbit_np *cnp;
431 	int ret;
432 
433 	if ((ksockaddr->ss_family != AF_INET) &&
434 	    (ksockaddr->ss_family != AF_INET6))
435 		return -EINVAL;
436 
437 	cnp = kzalloc(sizeof(*cnp), GFP_KERNEL);
438 	if (!cnp)
439 		return -ENOMEM;
440 
441 	init_waitqueue_head(&cnp->accept_wait);
442 	init_completion(&cnp->com.wr_wait.completion);
443 	init_completion(&cnp->accept_comp);
444 	INIT_LIST_HEAD(&cnp->np_accept_list);
445 	spin_lock_init(&cnp->np_accept_lock);
446 	kref_init(&cnp->kref);
447 	memcpy(&np->np_sockaddr, ksockaddr,
448 	       sizeof(struct sockaddr_storage));
449 	memcpy(&cnp->com.local_addr, &np->np_sockaddr,
450 	       sizeof(cnp->com.local_addr));
451 
452 	cnp->np = np;
453 	cnp->com.cdev = NULL;
454 
455 	if (cxgbit_inaddr_any(cnp))
456 		ret = cxgbit_setup_all_np(cnp);
457 	else
458 		ret = cxgbit_setup_cdev_np(cnp);
459 
460 	if (ret) {
461 		cxgbit_put_cnp(cnp);
462 		return -EINVAL;
463 	}
464 
465 	np->np_context = cnp;
466 	cnp->com.state = CSK_STATE_LISTEN;
467 	return 0;
468 }
469 
470 static void
471 cxgbit_set_conn_info(struct iscsi_np *np, struct iscsi_conn *conn,
472 		     struct cxgbit_sock *csk)
473 {
474 	conn->login_family = np->np_sockaddr.ss_family;
475 	conn->login_sockaddr = csk->com.remote_addr;
476 	conn->local_sockaddr = csk->com.local_addr;
477 }
478 
479 int cxgbit_accept_np(struct iscsi_np *np, struct iscsi_conn *conn)
480 {
481 	struct cxgbit_np *cnp = np->np_context;
482 	struct cxgbit_sock *csk;
483 	int ret = 0;
484 
485 accept_wait:
486 	ret = wait_for_completion_interruptible(&cnp->accept_comp);
487 	if (ret)
488 		return -ENODEV;
489 
490 	spin_lock_bh(&np->np_thread_lock);
491 	if (np->np_thread_state >= ISCSI_NP_THREAD_RESET) {
492 		spin_unlock_bh(&np->np_thread_lock);
493 		/**
494 		 * No point in stalling here when np_thread
495 		 * is in state RESET/SHUTDOWN/EXIT - bail
496 		 **/
497 		return -ENODEV;
498 	}
499 	spin_unlock_bh(&np->np_thread_lock);
500 
501 	spin_lock_bh(&cnp->np_accept_lock);
502 	if (list_empty(&cnp->np_accept_list)) {
503 		spin_unlock_bh(&cnp->np_accept_lock);
504 		goto accept_wait;
505 	}
506 
507 	csk = list_first_entry(&cnp->np_accept_list,
508 			       struct cxgbit_sock,
509 			       accept_node);
510 
511 	list_del_init(&csk->accept_node);
512 	spin_unlock_bh(&cnp->np_accept_lock);
513 	conn->context = csk;
514 	csk->conn = conn;
515 
516 	cxgbit_set_conn_info(np, conn, csk);
517 	return 0;
518 }
519 
520 static int
521 __cxgbit_free_cdev_np(struct cxgbit_device *cdev, struct cxgbit_np *cnp)
522 {
523 	int stid, ret;
524 	bool ipv6 = false;
525 
526 	stid = cxgbit_np_hash_del(cdev, cnp);
527 	if (stid < 0)
528 		return -EINVAL;
529 	if (!test_bit(CDEV_STATE_UP, &cdev->flags))
530 		return -EINVAL;
531 
532 	if (cnp->np->np_sockaddr.ss_family == AF_INET6)
533 		ipv6 = true;
534 
535 	cxgbit_get_cnp(cnp);
536 	cxgbit_init_wr_wait(&cnp->com.wr_wait);
537 	ret = cxgb4_remove_server(cdev->lldi.ports[0], stid,
538 				  cdev->lldi.rxq_ids[0], ipv6);
539 
540 	if (ret > 0)
541 		ret = net_xmit_errno(ret);
542 
543 	if (ret) {
544 		cxgbit_put_cnp(cnp);
545 		return ret;
546 	}
547 
548 	ret = cxgbit_wait_for_reply(cdev, &cnp->com.wr_wait,
549 				    0, 10, __func__);
550 	if (ret == -ETIMEDOUT)
551 		return ret;
552 
553 	if (ipv6 && cnp->com.cdev) {
554 		struct sockaddr_in6 *sin6;
555 
556 		sin6 = (struct sockaddr_in6 *)&cnp->com.local_addr;
557 		cxgb4_clip_release(cdev->lldi.ports[0],
558 				   (const u32 *)&sin6->sin6_addr.s6_addr,
559 				   1);
560 	}
561 
562 	cxgb4_free_stid(cdev->lldi.tids, stid,
563 			cnp->com.local_addr.ss_family);
564 	return 0;
565 }
566 
567 static void cxgbit_free_all_np(struct cxgbit_np *cnp)
568 {
569 	struct cxgbit_device *cdev;
570 	int ret;
571 
572 	mutex_lock(&cdev_list_lock);
573 	list_for_each_entry(cdev, &cdev_list_head, list) {
574 		ret = __cxgbit_free_cdev_np(cdev, cnp);
575 		if (ret == -ETIMEDOUT)
576 			break;
577 	}
578 	mutex_unlock(&cdev_list_lock);
579 }
580 
581 static void cxgbit_free_cdev_np(struct cxgbit_np *cnp)
582 {
583 	struct cxgbit_device *cdev;
584 	bool found = false;
585 
586 	mutex_lock(&cdev_list_lock);
587 	list_for_each_entry(cdev, &cdev_list_head, list) {
588 		if (cdev == cnp->com.cdev) {
589 			found = true;
590 			break;
591 		}
592 	}
593 	if (!found)
594 		goto out;
595 
596 	__cxgbit_free_cdev_np(cdev, cnp);
597 out:
598 	mutex_unlock(&cdev_list_lock);
599 }
600 
601 void cxgbit_free_np(struct iscsi_np *np)
602 {
603 	struct cxgbit_np *cnp = np->np_context;
604 
605 	cnp->com.state = CSK_STATE_DEAD;
606 	if (cnp->com.cdev)
607 		cxgbit_free_cdev_np(cnp);
608 	else
609 		cxgbit_free_all_np(cnp);
610 
611 	np->np_context = NULL;
612 	cxgbit_put_cnp(cnp);
613 }
614 
615 static void cxgbit_send_halfclose(struct cxgbit_sock *csk)
616 {
617 	struct sk_buff *skb;
618 	u32 len = roundup(sizeof(struct cpl_close_con_req), 16);
619 
620 	skb = alloc_skb(len, GFP_ATOMIC);
621 	if (!skb)
622 		return;
623 
624 	cxgb_mk_close_con_req(skb, len, csk->tid, csk->txq_idx,
625 			      NULL, NULL);
626 
627 	cxgbit_skcb_flags(skb) |= SKCBF_TX_FLAG_COMPL;
628 	__skb_queue_tail(&csk->txq, skb);
629 	cxgbit_push_tx_frames(csk);
630 }
631 
632 static void cxgbit_arp_failure_discard(void *handle, struct sk_buff *skb)
633 {
634 	pr_debug("%s cxgbit_device %p\n", __func__, handle);
635 	kfree_skb(skb);
636 }
637 
638 static void cxgbit_abort_arp_failure(void *handle, struct sk_buff *skb)
639 {
640 	struct cxgbit_device *cdev = handle;
641 	struct cpl_abort_req *req = cplhdr(skb);
642 
643 	pr_debug("%s cdev %p\n", __func__, cdev);
644 	req->cmd = CPL_ABORT_NO_RST;
645 	cxgbit_ofld_send(cdev, skb);
646 }
647 
648 static int cxgbit_send_abort_req(struct cxgbit_sock *csk)
649 {
650 	struct sk_buff *skb;
651 	u32 len = roundup(sizeof(struct cpl_abort_req), 16);
652 
653 	pr_debug("%s: csk %p tid %u; state %d\n",
654 		 __func__, csk, csk->tid, csk->com.state);
655 
656 	__skb_queue_purge(&csk->txq);
657 
658 	if (!test_and_set_bit(CSK_TX_DATA_SENT, &csk->com.flags))
659 		cxgbit_send_tx_flowc_wr(csk);
660 
661 	skb = __skb_dequeue(&csk->skbq);
662 	cxgb_mk_abort_req(skb, len, csk->tid, csk->txq_idx,
663 			  csk->com.cdev, cxgbit_abort_arp_failure);
664 
665 	return cxgbit_l2t_send(csk->com.cdev, skb, csk->l2t);
666 }
667 
668 void cxgbit_free_conn(struct iscsi_conn *conn)
669 {
670 	struct cxgbit_sock *csk = conn->context;
671 	bool release = false;
672 
673 	pr_debug("%s: state %d\n",
674 		 __func__, csk->com.state);
675 
676 	spin_lock_bh(&csk->lock);
677 	switch (csk->com.state) {
678 	case CSK_STATE_ESTABLISHED:
679 		if (conn->conn_state == TARG_CONN_STATE_IN_LOGOUT) {
680 			csk->com.state = CSK_STATE_CLOSING;
681 			cxgbit_send_halfclose(csk);
682 		} else {
683 			csk->com.state = CSK_STATE_ABORTING;
684 			cxgbit_send_abort_req(csk);
685 		}
686 		break;
687 	case CSK_STATE_CLOSING:
688 		csk->com.state = CSK_STATE_MORIBUND;
689 		cxgbit_send_halfclose(csk);
690 		break;
691 	case CSK_STATE_DEAD:
692 		release = true;
693 		break;
694 	default:
695 		pr_err("%s: csk %p; state %d\n",
696 		       __func__, csk, csk->com.state);
697 	}
698 	spin_unlock_bh(&csk->lock);
699 
700 	if (release)
701 		cxgbit_put_csk(csk);
702 }
703 
704 static void cxgbit_set_emss(struct cxgbit_sock *csk, u16 opt)
705 {
706 	csk->emss = csk->com.cdev->lldi.mtus[TCPOPT_MSS_G(opt)] -
707 			((csk->com.remote_addr.ss_family == AF_INET) ?
708 			sizeof(struct iphdr) : sizeof(struct ipv6hdr)) -
709 			sizeof(struct tcphdr);
710 	csk->mss = csk->emss;
711 	if (TCPOPT_TSTAMP_G(opt))
712 		csk->emss -= round_up(TCPOLEN_TIMESTAMP, 4);
713 	if (csk->emss < 128)
714 		csk->emss = 128;
715 	if (csk->emss & 7)
716 		pr_info("Warning: misaligned mtu idx %u mss %u emss=%u\n",
717 			TCPOPT_MSS_G(opt), csk->mss, csk->emss);
718 	pr_debug("%s mss_idx %u mss %u emss=%u\n", __func__, TCPOPT_MSS_G(opt),
719 		 csk->mss, csk->emss);
720 }
721 
722 static void cxgbit_free_skb(struct cxgbit_sock *csk)
723 {
724 	struct sk_buff *skb;
725 
726 	__skb_queue_purge(&csk->txq);
727 	__skb_queue_purge(&csk->rxq);
728 	__skb_queue_purge(&csk->backlogq);
729 	__skb_queue_purge(&csk->ppodq);
730 	__skb_queue_purge(&csk->skbq);
731 
732 	while ((skb = cxgbit_sock_dequeue_wr(csk)))
733 		kfree_skb(skb);
734 
735 	__kfree_skb(csk->lro_hskb);
736 }
737 
738 void _cxgbit_free_csk(struct kref *kref)
739 {
740 	struct cxgbit_sock *csk;
741 	struct cxgbit_device *cdev;
742 
743 	csk = container_of(kref, struct cxgbit_sock, kref);
744 
745 	pr_debug("%s csk %p state %d\n", __func__, csk, csk->com.state);
746 
747 	if (csk->com.local_addr.ss_family == AF_INET6) {
748 		struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)
749 					     &csk->com.local_addr;
750 		cxgb4_clip_release(csk->com.cdev->lldi.ports[0],
751 				   (const u32 *)
752 				   &sin6->sin6_addr.s6_addr, 1);
753 	}
754 
755 	cxgb4_remove_tid(csk->com.cdev->lldi.tids, 0, csk->tid);
756 	dst_release(csk->dst);
757 	cxgb4_l2t_release(csk->l2t);
758 
759 	cdev = csk->com.cdev;
760 	spin_lock_bh(&cdev->cskq.lock);
761 	list_del(&csk->list);
762 	spin_unlock_bh(&cdev->cskq.lock);
763 
764 	cxgbit_free_skb(csk);
765 	cxgbit_put_cdev(cdev);
766 
767 	kfree(csk);
768 }
769 
770 static void cxgbit_set_tcp_window(struct cxgbit_sock *csk, struct port_info *pi)
771 {
772 	unsigned int linkspeed;
773 	u8 scale;
774 
775 	linkspeed = pi->link_cfg.speed;
776 	scale = linkspeed / SPEED_10000;
777 
778 #define CXGBIT_10G_RCV_WIN (256 * 1024)
779 	csk->rcv_win = CXGBIT_10G_RCV_WIN;
780 	if (scale)
781 		csk->rcv_win *= scale;
782 
783 #define CXGBIT_10G_SND_WIN (256 * 1024)
784 	csk->snd_win = CXGBIT_10G_SND_WIN;
785 	if (scale)
786 		csk->snd_win *= scale;
787 
788 	pr_debug("%s snd_win %d rcv_win %d\n",
789 		 __func__, csk->snd_win, csk->rcv_win);
790 }
791 
792 #ifdef CONFIG_CHELSIO_T4_DCB
793 static u8 cxgbit_get_iscsi_dcb_state(struct net_device *ndev)
794 {
795 	return ndev->dcbnl_ops->getstate(ndev);
796 }
797 
798 static int cxgbit_select_priority(int pri_mask)
799 {
800 	if (!pri_mask)
801 		return 0;
802 
803 	return (ffs(pri_mask) - 1);
804 }
805 
806 static u8 cxgbit_get_iscsi_dcb_priority(struct net_device *ndev, u16 local_port)
807 {
808 	int ret;
809 	u8 caps;
810 
811 	struct dcb_app iscsi_dcb_app = {
812 		.protocol = local_port
813 	};
814 
815 	ret = (int)ndev->dcbnl_ops->getcap(ndev, DCB_CAP_ATTR_DCBX, &caps);
816 
817 	if (ret)
818 		return 0;
819 
820 	if (caps & DCB_CAP_DCBX_VER_IEEE) {
821 		iscsi_dcb_app.selector = IEEE_8021QAZ_APP_SEL_ANY;
822 
823 		ret = dcb_ieee_getapp_mask(ndev, &iscsi_dcb_app);
824 
825 	} else if (caps & DCB_CAP_DCBX_VER_CEE) {
826 		iscsi_dcb_app.selector = DCB_APP_IDTYPE_PORTNUM;
827 
828 		ret = dcb_getapp(ndev, &iscsi_dcb_app);
829 	}
830 
831 	pr_info("iSCSI priority is set to %u\n", cxgbit_select_priority(ret));
832 
833 	return cxgbit_select_priority(ret);
834 }
835 #endif
836 
837 static int
838 cxgbit_offload_init(struct cxgbit_sock *csk, int iptype, __u8 *peer_ip,
839 		    u16 local_port, struct dst_entry *dst,
840 		    struct cxgbit_device *cdev)
841 {
842 	struct neighbour *n;
843 	int ret, step;
844 	struct net_device *ndev;
845 	u16 rxq_idx, port_id;
846 #ifdef CONFIG_CHELSIO_T4_DCB
847 	u8 priority = 0;
848 #endif
849 
850 	n = dst_neigh_lookup(dst, peer_ip);
851 	if (!n)
852 		return -ENODEV;
853 
854 	rcu_read_lock();
855 	ret = -ENOMEM;
856 	if (n->dev->flags & IFF_LOOPBACK) {
857 		if (iptype == 4)
858 			ndev = cxgbit_ipv4_netdev(*(__be32 *)peer_ip);
859 		else if (IS_ENABLED(CONFIG_IPV6))
860 			ndev = cxgbit_ipv6_netdev((struct in6_addr *)peer_ip);
861 		else
862 			ndev = NULL;
863 
864 		if (!ndev) {
865 			ret = -ENODEV;
866 			goto out;
867 		}
868 
869 		csk->l2t = cxgb4_l2t_get(cdev->lldi.l2t,
870 					 n, ndev, 0);
871 		if (!csk->l2t)
872 			goto out;
873 		csk->mtu = ndev->mtu;
874 		csk->tx_chan = cxgb4_port_chan(ndev);
875 		csk->smac_idx = cxgb4_tp_smt_idx(cdev->lldi.adapter_type,
876 						 cxgb4_port_viid(ndev));
877 		step = cdev->lldi.ntxq /
878 			cdev->lldi.nchan;
879 		csk->txq_idx = cxgb4_port_idx(ndev) * step;
880 		step = cdev->lldi.nrxq /
881 			cdev->lldi.nchan;
882 		csk->ctrlq_idx = cxgb4_port_idx(ndev);
883 		csk->rss_qid = cdev->lldi.rxq_ids[
884 				cxgb4_port_idx(ndev) * step];
885 		csk->port_id = cxgb4_port_idx(ndev);
886 		cxgbit_set_tcp_window(csk,
887 				      (struct port_info *)netdev_priv(ndev));
888 	} else {
889 		ndev = cxgbit_get_real_dev(n->dev);
890 		if (!ndev) {
891 			ret = -ENODEV;
892 			goto out;
893 		}
894 
895 #ifdef CONFIG_CHELSIO_T4_DCB
896 		if (cxgbit_get_iscsi_dcb_state(ndev))
897 			priority = cxgbit_get_iscsi_dcb_priority(ndev,
898 								 local_port);
899 
900 		csk->dcb_priority = priority;
901 
902 		csk->l2t = cxgb4_l2t_get(cdev->lldi.l2t, n, ndev, priority);
903 #else
904 		csk->l2t = cxgb4_l2t_get(cdev->lldi.l2t, n, ndev, 0);
905 #endif
906 		if (!csk->l2t)
907 			goto out;
908 		port_id = cxgb4_port_idx(ndev);
909 		csk->mtu = dst_mtu(dst);
910 		csk->tx_chan = cxgb4_port_chan(ndev);
911 		csk->smac_idx = cxgb4_tp_smt_idx(cdev->lldi.adapter_type,
912 						 cxgb4_port_viid(ndev));
913 		step = cdev->lldi.ntxq /
914 			cdev->lldi.nports;
915 		csk->txq_idx = (port_id * step) +
916 				(cdev->selectq[port_id][0]++ % step);
917 		csk->ctrlq_idx = cxgb4_port_idx(ndev);
918 		step = cdev->lldi.nrxq /
919 			cdev->lldi.nports;
920 		rxq_idx = (port_id * step) +
921 				(cdev->selectq[port_id][1]++ % step);
922 		csk->rss_qid = cdev->lldi.rxq_ids[rxq_idx];
923 		csk->port_id = port_id;
924 		cxgbit_set_tcp_window(csk,
925 				      (struct port_info *)netdev_priv(ndev));
926 	}
927 	ret = 0;
928 out:
929 	rcu_read_unlock();
930 	neigh_release(n);
931 	return ret;
932 }
933 
934 int cxgbit_ofld_send(struct cxgbit_device *cdev, struct sk_buff *skb)
935 {
936 	int ret = 0;
937 
938 	if (!test_bit(CDEV_STATE_UP, &cdev->flags)) {
939 		kfree_skb(skb);
940 		pr_err("%s - device not up - dropping\n", __func__);
941 		return -EIO;
942 	}
943 
944 	ret = cxgb4_ofld_send(cdev->lldi.ports[0], skb);
945 	if (ret < 0)
946 		kfree_skb(skb);
947 	return ret < 0 ? ret : 0;
948 }
949 
950 static void cxgbit_release_tid(struct cxgbit_device *cdev, u32 tid)
951 {
952 	u32 len = roundup(sizeof(struct cpl_tid_release), 16);
953 	struct sk_buff *skb;
954 
955 	skb = alloc_skb(len, GFP_ATOMIC);
956 	if (!skb)
957 		return;
958 
959 	cxgb_mk_tid_release(skb, len, tid, 0);
960 	cxgbit_ofld_send(cdev, skb);
961 }
962 
963 int
964 cxgbit_l2t_send(struct cxgbit_device *cdev, struct sk_buff *skb,
965 		struct l2t_entry *l2e)
966 {
967 	int ret = 0;
968 
969 	if (!test_bit(CDEV_STATE_UP, &cdev->flags)) {
970 		kfree_skb(skb);
971 		pr_err("%s - device not up - dropping\n", __func__);
972 		return -EIO;
973 	}
974 
975 	ret = cxgb4_l2t_send(cdev->lldi.ports[0], skb, l2e);
976 	if (ret < 0)
977 		kfree_skb(skb);
978 	return ret < 0 ? ret : 0;
979 }
980 
981 static void cxgbit_send_rx_credits(struct cxgbit_sock *csk, struct sk_buff *skb)
982 {
983 	if (csk->com.state != CSK_STATE_ESTABLISHED) {
984 		__kfree_skb(skb);
985 		return;
986 	}
987 
988 	cxgbit_ofld_send(csk->com.cdev, skb);
989 }
990 
991 /*
992  * CPL connection rx data ack: host ->
993  * Send RX credits through an RX_DATA_ACK CPL message.
994  * Returns the number of credits sent.
995  */
996 int cxgbit_rx_data_ack(struct cxgbit_sock *csk)
997 {
998 	struct sk_buff *skb;
999 	u32 len = roundup(sizeof(struct cpl_rx_data_ack), 16);
1000 	u32 credit_dack;
1001 
1002 	skb = alloc_skb(len, GFP_KERNEL);
1003 	if (!skb)
1004 		return -1;
1005 
1006 	credit_dack = RX_DACK_CHANGE_F | RX_DACK_MODE_V(1) |
1007 		      RX_CREDITS_V(csk->rx_credits);
1008 
1009 	cxgb_mk_rx_data_ack(skb, len, csk->tid, csk->ctrlq_idx,
1010 			    credit_dack);
1011 
1012 	csk->rx_credits = 0;
1013 
1014 	spin_lock_bh(&csk->lock);
1015 	if (csk->lock_owner) {
1016 		cxgbit_skcb_rx_backlog_fn(skb) = cxgbit_send_rx_credits;
1017 		__skb_queue_tail(&csk->backlogq, skb);
1018 		spin_unlock_bh(&csk->lock);
1019 		return 0;
1020 	}
1021 
1022 	cxgbit_send_rx_credits(csk, skb);
1023 	spin_unlock_bh(&csk->lock);
1024 
1025 	return 0;
1026 }
1027 
1028 #define FLOWC_WR_NPARAMS_MIN    9
1029 #define FLOWC_WR_NPARAMS_MAX	11
1030 static int cxgbit_alloc_csk_skb(struct cxgbit_sock *csk)
1031 {
1032 	struct sk_buff *skb;
1033 	u32 len, flowclen;
1034 	u8 i;
1035 
1036 	flowclen = offsetof(struct fw_flowc_wr,
1037 			    mnemval[FLOWC_WR_NPARAMS_MAX]);
1038 
1039 	len = max_t(u32, sizeof(struct cpl_abort_req),
1040 		    sizeof(struct cpl_abort_rpl));
1041 
1042 	len = max(len, flowclen);
1043 	len = roundup(len, 16);
1044 
1045 	for (i = 0; i < 3; i++) {
1046 		skb = alloc_skb(len, GFP_ATOMIC);
1047 		if (!skb)
1048 			goto out;
1049 		__skb_queue_tail(&csk->skbq, skb);
1050 	}
1051 
1052 	skb = alloc_skb(LRO_SKB_MIN_HEADROOM, GFP_ATOMIC);
1053 	if (!skb)
1054 		goto out;
1055 
1056 	memset(skb->data, 0, LRO_SKB_MIN_HEADROOM);
1057 	csk->lro_hskb = skb;
1058 
1059 	return 0;
1060 out:
1061 	__skb_queue_purge(&csk->skbq);
1062 	return -ENOMEM;
1063 }
1064 
1065 static void
1066 cxgbit_pass_accept_rpl(struct cxgbit_sock *csk, struct cpl_pass_accept_req *req)
1067 {
1068 	struct sk_buff *skb;
1069 	const struct tcphdr *tcph;
1070 	struct cpl_t5_pass_accept_rpl *rpl5;
1071 	struct cxgb4_lld_info *lldi = &csk->com.cdev->lldi;
1072 	unsigned int len = roundup(sizeof(*rpl5), 16);
1073 	unsigned int mtu_idx;
1074 	u64 opt0;
1075 	u32 opt2, hlen;
1076 	u32 wscale;
1077 	u32 win;
1078 
1079 	pr_debug("%s csk %p tid %u\n", __func__, csk, csk->tid);
1080 
1081 	skb = alloc_skb(len, GFP_ATOMIC);
1082 	if (!skb) {
1083 		cxgbit_put_csk(csk);
1084 		return;
1085 	}
1086 
1087 	rpl5 = (struct cpl_t5_pass_accept_rpl *)__skb_put(skb, len);
1088 	memset(rpl5, 0, len);
1089 
1090 	INIT_TP_WR(rpl5, csk->tid);
1091 	OPCODE_TID(rpl5) = cpu_to_be32(MK_OPCODE_TID(CPL_PASS_ACCEPT_RPL,
1092 						     csk->tid));
1093 	cxgb_best_mtu(csk->com.cdev->lldi.mtus, csk->mtu, &mtu_idx,
1094 		      req->tcpopt.tstamp,
1095 		      (csk->com.remote_addr.ss_family == AF_INET) ? 0 : 1);
1096 	wscale = cxgb_compute_wscale(csk->rcv_win);
1097 	/*
1098 	 * Specify the largest window that will fit in opt0. The
1099 	 * remainder will be specified in the rx_data_ack.
1100 	 */
1101 	win = csk->rcv_win >> 10;
1102 	if (win > RCV_BUFSIZ_M)
1103 		win = RCV_BUFSIZ_M;
1104 	opt0 =  TCAM_BYPASS_F |
1105 		WND_SCALE_V(wscale) |
1106 		MSS_IDX_V(mtu_idx) |
1107 		L2T_IDX_V(csk->l2t->idx) |
1108 		TX_CHAN_V(csk->tx_chan) |
1109 		SMAC_SEL_V(csk->smac_idx) |
1110 		DSCP_V(csk->tos >> 2) |
1111 		ULP_MODE_V(ULP_MODE_ISCSI) |
1112 		RCV_BUFSIZ_V(win);
1113 
1114 	opt2 = RX_CHANNEL_V(0) |
1115 		RSS_QUEUE_VALID_F | RSS_QUEUE_V(csk->rss_qid);
1116 
1117 	if (!is_t5(lldi->adapter_type))
1118 		opt2 |= RX_FC_DISABLE_F;
1119 
1120 	if (req->tcpopt.tstamp)
1121 		opt2 |= TSTAMPS_EN_F;
1122 	if (req->tcpopt.sack)
1123 		opt2 |= SACK_EN_F;
1124 	if (wscale)
1125 		opt2 |= WND_SCALE_EN_F;
1126 
1127 	hlen = ntohl(req->hdr_len);
1128 
1129 	if (is_t5(lldi->adapter_type))
1130 		tcph = (struct tcphdr *)((u8 *)(req + 1) +
1131 		       ETH_HDR_LEN_G(hlen) + IP_HDR_LEN_G(hlen));
1132 	else
1133 		tcph = (struct tcphdr *)((u8 *)(req + 1) +
1134 		       T6_ETH_HDR_LEN_G(hlen) + T6_IP_HDR_LEN_G(hlen));
1135 
1136 	if (tcph->ece && tcph->cwr)
1137 		opt2 |= CCTRL_ECN_V(1);
1138 
1139 	opt2 |= RX_COALESCE_V(3);
1140 	opt2 |= CONG_CNTRL_V(CONG_ALG_NEWRENO);
1141 
1142 	opt2 |= T5_ISS_F;
1143 	rpl5->iss = cpu_to_be32((prandom_u32() & ~7UL) - 1);
1144 
1145 	opt2 |= T5_OPT_2_VALID_F;
1146 
1147 	rpl5->opt0 = cpu_to_be64(opt0);
1148 	rpl5->opt2 = cpu_to_be32(opt2);
1149 	set_wr_txq(skb, CPL_PRIORITY_SETUP, csk->ctrlq_idx);
1150 	t4_set_arp_err_handler(skb, NULL, cxgbit_arp_failure_discard);
1151 	cxgbit_l2t_send(csk->com.cdev, skb, csk->l2t);
1152 }
1153 
1154 static void
1155 cxgbit_pass_accept_req(struct cxgbit_device *cdev, struct sk_buff *skb)
1156 {
1157 	struct cxgbit_sock *csk = NULL;
1158 	struct cxgbit_np *cnp;
1159 	struct cpl_pass_accept_req *req = cplhdr(skb);
1160 	unsigned int stid = PASS_OPEN_TID_G(ntohl(req->tos_stid));
1161 	struct tid_info *t = cdev->lldi.tids;
1162 	unsigned int tid = GET_TID(req);
1163 	u16 peer_mss = ntohs(req->tcpopt.mss);
1164 	unsigned short hdrs;
1165 
1166 	struct dst_entry *dst;
1167 	__u8 local_ip[16], peer_ip[16];
1168 	__be16 local_port, peer_port;
1169 	int ret;
1170 	int iptype;
1171 
1172 	pr_debug("%s: cdev = %p; stid = %u; tid = %u\n",
1173 		 __func__, cdev, stid, tid);
1174 
1175 	cnp = lookup_stid(t, stid);
1176 	if (!cnp) {
1177 		pr_err("%s connect request on invalid stid %d\n",
1178 		       __func__, stid);
1179 		goto rel_skb;
1180 	}
1181 
1182 	if (cnp->com.state != CSK_STATE_LISTEN) {
1183 		pr_err("%s - listening parent not in CSK_STATE_LISTEN\n",
1184 		       __func__);
1185 		goto reject;
1186 	}
1187 
1188 	csk = lookup_tid(t, tid);
1189 	if (csk) {
1190 		pr_err("%s csk not null tid %u\n",
1191 		       __func__, tid);
1192 		goto rel_skb;
1193 	}
1194 
1195 	cxgb_get_4tuple(req, cdev->lldi.adapter_type, &iptype, local_ip,
1196 			peer_ip, &local_port, &peer_port);
1197 
1198 	/* Find output route */
1199 	if (iptype == 4)  {
1200 		pr_debug("%s parent sock %p tid %u laddr %pI4 raddr %pI4 "
1201 			 "lport %d rport %d peer_mss %d\n"
1202 			 , __func__, cnp, tid,
1203 			 local_ip, peer_ip, ntohs(local_port),
1204 			 ntohs(peer_port), peer_mss);
1205 		dst = cxgb_find_route(&cdev->lldi, cxgbit_get_real_dev,
1206 				      *(__be32 *)local_ip,
1207 				      *(__be32 *)peer_ip,
1208 				      local_port, peer_port,
1209 				      PASS_OPEN_TOS_G(ntohl(req->tos_stid)));
1210 	} else {
1211 		pr_debug("%s parent sock %p tid %u laddr %pI6 raddr %pI6 "
1212 			 "lport %d rport %d peer_mss %d\n"
1213 			 , __func__, cnp, tid,
1214 			 local_ip, peer_ip, ntohs(local_port),
1215 			 ntohs(peer_port), peer_mss);
1216 		dst = cxgb_find_route6(&cdev->lldi, cxgbit_get_real_dev,
1217 				       local_ip, peer_ip,
1218 				       local_port, peer_port,
1219 				       PASS_OPEN_TOS_G(ntohl(req->tos_stid)),
1220 				       ((struct sockaddr_in6 *)
1221 					&cnp->com.local_addr)->sin6_scope_id);
1222 	}
1223 	if (!dst) {
1224 		pr_err("%s - failed to find dst entry!\n",
1225 		       __func__);
1226 		goto reject;
1227 	}
1228 
1229 	csk = kzalloc(sizeof(*csk), GFP_ATOMIC);
1230 	if (!csk) {
1231 		dst_release(dst);
1232 		goto rel_skb;
1233 	}
1234 
1235 	ret = cxgbit_offload_init(csk, iptype, peer_ip, ntohs(local_port),
1236 				  dst, cdev);
1237 	if (ret) {
1238 		pr_err("%s - failed to allocate l2t entry!\n",
1239 		       __func__);
1240 		dst_release(dst);
1241 		kfree(csk);
1242 		goto reject;
1243 	}
1244 
1245 	kref_init(&csk->kref);
1246 	init_completion(&csk->com.wr_wait.completion);
1247 
1248 	INIT_LIST_HEAD(&csk->accept_node);
1249 
1250 	hdrs = (iptype == 4 ? sizeof(struct iphdr) : sizeof(struct ipv6hdr)) +
1251 		sizeof(struct tcphdr) +	(req->tcpopt.tstamp ? 12 : 0);
1252 	if (peer_mss && csk->mtu > (peer_mss + hdrs))
1253 		csk->mtu = peer_mss + hdrs;
1254 
1255 	csk->com.state = CSK_STATE_CONNECTING;
1256 	csk->com.cdev = cdev;
1257 	csk->cnp = cnp;
1258 	csk->tos = PASS_OPEN_TOS_G(ntohl(req->tos_stid));
1259 	csk->dst = dst;
1260 	csk->tid = tid;
1261 	csk->wr_cred = cdev->lldi.wr_cred -
1262 			DIV_ROUND_UP(sizeof(struct cpl_abort_req), 16);
1263 	csk->wr_max_cred = csk->wr_cred;
1264 	csk->wr_una_cred = 0;
1265 
1266 	if (iptype == 4) {
1267 		struct sockaddr_in *sin = (struct sockaddr_in *)
1268 					  &csk->com.local_addr;
1269 		sin->sin_family = AF_INET;
1270 		sin->sin_port = local_port;
1271 		sin->sin_addr.s_addr = *(__be32 *)local_ip;
1272 
1273 		sin = (struct sockaddr_in *)&csk->com.remote_addr;
1274 		sin->sin_family = AF_INET;
1275 		sin->sin_port = peer_port;
1276 		sin->sin_addr.s_addr = *(__be32 *)peer_ip;
1277 	} else {
1278 		struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)
1279 					    &csk->com.local_addr;
1280 
1281 		sin6->sin6_family = PF_INET6;
1282 		sin6->sin6_port = local_port;
1283 		memcpy(sin6->sin6_addr.s6_addr, local_ip, 16);
1284 		cxgb4_clip_get(cdev->lldi.ports[0],
1285 			       (const u32 *)&sin6->sin6_addr.s6_addr,
1286 			       1);
1287 
1288 		sin6 = (struct sockaddr_in6 *)&csk->com.remote_addr;
1289 		sin6->sin6_family = PF_INET6;
1290 		sin6->sin6_port = peer_port;
1291 		memcpy(sin6->sin6_addr.s6_addr, peer_ip, 16);
1292 	}
1293 
1294 	skb_queue_head_init(&csk->rxq);
1295 	skb_queue_head_init(&csk->txq);
1296 	skb_queue_head_init(&csk->ppodq);
1297 	skb_queue_head_init(&csk->backlogq);
1298 	skb_queue_head_init(&csk->skbq);
1299 	cxgbit_sock_reset_wr_list(csk);
1300 	spin_lock_init(&csk->lock);
1301 	init_waitqueue_head(&csk->waitq);
1302 	init_waitqueue_head(&csk->ack_waitq);
1303 	csk->lock_owner = false;
1304 
1305 	if (cxgbit_alloc_csk_skb(csk)) {
1306 		dst_release(dst);
1307 		kfree(csk);
1308 		goto rel_skb;
1309 	}
1310 
1311 	cxgbit_get_cdev(cdev);
1312 
1313 	spin_lock(&cdev->cskq.lock);
1314 	list_add_tail(&csk->list, &cdev->cskq.list);
1315 	spin_unlock(&cdev->cskq.lock);
1316 
1317 	cxgb4_insert_tid(t, csk, tid);
1318 	cxgbit_pass_accept_rpl(csk, req);
1319 	goto rel_skb;
1320 
1321 reject:
1322 	cxgbit_release_tid(cdev, tid);
1323 rel_skb:
1324 	__kfree_skb(skb);
1325 }
1326 
1327 static u32
1328 cxgbit_tx_flowc_wr_credits(struct cxgbit_sock *csk, u32 *nparamsp,
1329 			   u32 *flowclenp)
1330 {
1331 	u32 nparams, flowclen16, flowclen;
1332 
1333 	nparams = FLOWC_WR_NPARAMS_MIN;
1334 
1335 	if (csk->snd_wscale)
1336 		nparams++;
1337 
1338 #ifdef CONFIG_CHELSIO_T4_DCB
1339 	nparams++;
1340 #endif
1341 	flowclen = offsetof(struct fw_flowc_wr, mnemval[nparams]);
1342 	flowclen16 = DIV_ROUND_UP(flowclen, 16);
1343 	flowclen = flowclen16 * 16;
1344 	/*
1345 	 * Return the number of 16-byte credits used by the flowc request.
1346 	 * Pass back the nparams and actual flowc length if requested.
1347 	 */
1348 	if (nparamsp)
1349 		*nparamsp = nparams;
1350 	if (flowclenp)
1351 		*flowclenp = flowclen;
1352 	return flowclen16;
1353 }
1354 
1355 u32 cxgbit_send_tx_flowc_wr(struct cxgbit_sock *csk)
1356 {
1357 	struct cxgbit_device *cdev = csk->com.cdev;
1358 	struct fw_flowc_wr *flowc;
1359 	u32 nparams, flowclen16, flowclen;
1360 	struct sk_buff *skb;
1361 	u8 index;
1362 
1363 #ifdef CONFIG_CHELSIO_T4_DCB
1364 	u16 vlan = ((struct l2t_entry *)csk->l2t)->vlan;
1365 #endif
1366 
1367 	flowclen16 = cxgbit_tx_flowc_wr_credits(csk, &nparams, &flowclen);
1368 
1369 	skb = __skb_dequeue(&csk->skbq);
1370 	flowc = (struct fw_flowc_wr *)__skb_put(skb, flowclen);
1371 	memset(flowc, 0, flowclen);
1372 
1373 	flowc->op_to_nparams = cpu_to_be32(FW_WR_OP_V(FW_FLOWC_WR) |
1374 					   FW_FLOWC_WR_NPARAMS_V(nparams));
1375 	flowc->flowid_len16 = cpu_to_be32(FW_WR_LEN16_V(flowclen16) |
1376 					  FW_WR_FLOWID_V(csk->tid));
1377 	flowc->mnemval[0].mnemonic = FW_FLOWC_MNEM_PFNVFN;
1378 	flowc->mnemval[0].val = cpu_to_be32(FW_PFVF_CMD_PFN_V
1379 					    (csk->com.cdev->lldi.pf));
1380 	flowc->mnemval[1].mnemonic = FW_FLOWC_MNEM_CH;
1381 	flowc->mnemval[1].val = cpu_to_be32(csk->tx_chan);
1382 	flowc->mnemval[2].mnemonic = FW_FLOWC_MNEM_PORT;
1383 	flowc->mnemval[2].val = cpu_to_be32(csk->tx_chan);
1384 	flowc->mnemval[3].mnemonic = FW_FLOWC_MNEM_IQID;
1385 	flowc->mnemval[3].val = cpu_to_be32(csk->rss_qid);
1386 	flowc->mnemval[4].mnemonic = FW_FLOWC_MNEM_SNDNXT;
1387 	flowc->mnemval[4].val = cpu_to_be32(csk->snd_nxt);
1388 	flowc->mnemval[5].mnemonic = FW_FLOWC_MNEM_RCVNXT;
1389 	flowc->mnemval[5].val = cpu_to_be32(csk->rcv_nxt);
1390 	flowc->mnemval[6].mnemonic = FW_FLOWC_MNEM_SNDBUF;
1391 	flowc->mnemval[6].val = cpu_to_be32(csk->snd_win);
1392 	flowc->mnemval[7].mnemonic = FW_FLOWC_MNEM_MSS;
1393 	flowc->mnemval[7].val = cpu_to_be32(csk->emss);
1394 
1395 	flowc->mnemval[8].mnemonic = FW_FLOWC_MNEM_TXDATAPLEN_MAX;
1396 	if (test_bit(CDEV_ISO_ENABLE, &cdev->flags))
1397 		flowc->mnemval[8].val = cpu_to_be32(CXGBIT_MAX_ISO_PAYLOAD);
1398 	else
1399 		flowc->mnemval[8].val = cpu_to_be32(16384);
1400 
1401 	index = 9;
1402 
1403 	if (csk->snd_wscale) {
1404 		flowc->mnemval[index].mnemonic = FW_FLOWC_MNEM_RCV_SCALE;
1405 		flowc->mnemval[index].val = cpu_to_be32(csk->snd_wscale);
1406 		index++;
1407 	}
1408 
1409 #ifdef CONFIG_CHELSIO_T4_DCB
1410 	flowc->mnemval[index].mnemonic = FW_FLOWC_MNEM_DCBPRIO;
1411 	if (vlan == VLAN_NONE) {
1412 		pr_warn("csk %u without VLAN Tag on DCB Link\n", csk->tid);
1413 		flowc->mnemval[index].val = cpu_to_be32(0);
1414 	} else
1415 		flowc->mnemval[index].val = cpu_to_be32(
1416 				(vlan & VLAN_PRIO_MASK) >> VLAN_PRIO_SHIFT);
1417 #endif
1418 
1419 	pr_debug("%s: csk %p; tx_chan = %u; rss_qid = %u; snd_seq = %u;"
1420 		 " rcv_seq = %u; snd_win = %u; emss = %u\n",
1421 		 __func__, csk, csk->tx_chan, csk->rss_qid, csk->snd_nxt,
1422 		 csk->rcv_nxt, csk->snd_win, csk->emss);
1423 	set_wr_txq(skb, CPL_PRIORITY_DATA, csk->txq_idx);
1424 	cxgbit_ofld_send(csk->com.cdev, skb);
1425 	return flowclen16;
1426 }
1427 
1428 int cxgbit_setup_conn_digest(struct cxgbit_sock *csk)
1429 {
1430 	struct sk_buff *skb;
1431 	struct cpl_set_tcb_field *req;
1432 	u8 hcrc = csk->submode & CXGBIT_SUBMODE_HCRC;
1433 	u8 dcrc = csk->submode & CXGBIT_SUBMODE_DCRC;
1434 	unsigned int len = roundup(sizeof(*req), 16);
1435 	int ret;
1436 
1437 	skb = alloc_skb(len, GFP_KERNEL);
1438 	if (!skb)
1439 		return -ENOMEM;
1440 
1441 	/*  set up ulp submode */
1442 	req = (struct cpl_set_tcb_field *)__skb_put(skb, len);
1443 	memset(req, 0, len);
1444 
1445 	INIT_TP_WR(req, csk->tid);
1446 	OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD, csk->tid));
1447 	req->reply_ctrl = htons(NO_REPLY_V(0) | QUEUENO_V(csk->rss_qid));
1448 	req->word_cookie = htons(0);
1449 	req->mask = cpu_to_be64(0x3 << 4);
1450 	req->val = cpu_to_be64(((hcrc ? ULP_CRC_HEADER : 0) |
1451 				(dcrc ? ULP_CRC_DATA : 0)) << 4);
1452 	set_wr_txq(skb, CPL_PRIORITY_CONTROL, csk->ctrlq_idx);
1453 
1454 	cxgbit_get_csk(csk);
1455 	cxgbit_init_wr_wait(&csk->com.wr_wait);
1456 
1457 	cxgbit_ofld_send(csk->com.cdev, skb);
1458 
1459 	ret = cxgbit_wait_for_reply(csk->com.cdev,
1460 				    &csk->com.wr_wait,
1461 				    csk->tid, 5, __func__);
1462 	if (ret)
1463 		return -1;
1464 
1465 	return 0;
1466 }
1467 
1468 int cxgbit_setup_conn_pgidx(struct cxgbit_sock *csk, u32 pg_idx)
1469 {
1470 	struct sk_buff *skb;
1471 	struct cpl_set_tcb_field *req;
1472 	unsigned int len = roundup(sizeof(*req), 16);
1473 	int ret;
1474 
1475 	skb = alloc_skb(len, GFP_KERNEL);
1476 	if (!skb)
1477 		return -ENOMEM;
1478 
1479 	req = (struct cpl_set_tcb_field *)__skb_put(skb, len);
1480 	memset(req, 0, len);
1481 
1482 	INIT_TP_WR(req, csk->tid);
1483 	OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD, csk->tid));
1484 	req->reply_ctrl = htons(NO_REPLY_V(0) | QUEUENO_V(csk->rss_qid));
1485 	req->word_cookie = htons(0);
1486 	req->mask = cpu_to_be64(0x3 << 8);
1487 	req->val = cpu_to_be64(pg_idx << 8);
1488 	set_wr_txq(skb, CPL_PRIORITY_CONTROL, csk->ctrlq_idx);
1489 
1490 	cxgbit_get_csk(csk);
1491 	cxgbit_init_wr_wait(&csk->com.wr_wait);
1492 
1493 	cxgbit_ofld_send(csk->com.cdev, skb);
1494 
1495 	ret = cxgbit_wait_for_reply(csk->com.cdev,
1496 				    &csk->com.wr_wait,
1497 				    csk->tid, 5, __func__);
1498 	if (ret)
1499 		return -1;
1500 
1501 	return 0;
1502 }
1503 
1504 static void
1505 cxgbit_pass_open_rpl(struct cxgbit_device *cdev, struct sk_buff *skb)
1506 {
1507 	struct cpl_pass_open_rpl *rpl = cplhdr(skb);
1508 	struct tid_info *t = cdev->lldi.tids;
1509 	unsigned int stid = GET_TID(rpl);
1510 	struct cxgbit_np *cnp = lookup_stid(t, stid);
1511 
1512 	pr_debug("%s: cnp = %p; stid = %u; status = %d\n",
1513 		 __func__, cnp, stid, rpl->status);
1514 
1515 	if (!cnp) {
1516 		pr_info("%s stid %d lookup failure\n", __func__, stid);
1517 		return;
1518 	}
1519 
1520 	cxgbit_wake_up(&cnp->com.wr_wait, __func__, rpl->status);
1521 	cxgbit_put_cnp(cnp);
1522 }
1523 
1524 static void
1525 cxgbit_close_listsrv_rpl(struct cxgbit_device *cdev, struct sk_buff *skb)
1526 {
1527 	struct cpl_close_listsvr_rpl *rpl = cplhdr(skb);
1528 	struct tid_info *t = cdev->lldi.tids;
1529 	unsigned int stid = GET_TID(rpl);
1530 	struct cxgbit_np *cnp = lookup_stid(t, stid);
1531 
1532 	pr_debug("%s: cnp = %p; stid = %u; status = %d\n",
1533 		 __func__, cnp, stid, rpl->status);
1534 
1535 	if (!cnp) {
1536 		pr_info("%s stid %d lookup failure\n", __func__, stid);
1537 		return;
1538 	}
1539 
1540 	cxgbit_wake_up(&cnp->com.wr_wait, __func__, rpl->status);
1541 	cxgbit_put_cnp(cnp);
1542 }
1543 
1544 static void
1545 cxgbit_pass_establish(struct cxgbit_device *cdev, struct sk_buff *skb)
1546 {
1547 	struct cpl_pass_establish *req = cplhdr(skb);
1548 	struct tid_info *t = cdev->lldi.tids;
1549 	unsigned int tid = GET_TID(req);
1550 	struct cxgbit_sock *csk;
1551 	struct cxgbit_np *cnp;
1552 	u16 tcp_opt = be16_to_cpu(req->tcp_opt);
1553 	u32 snd_isn = be32_to_cpu(req->snd_isn);
1554 	u32 rcv_isn = be32_to_cpu(req->rcv_isn);
1555 
1556 	csk = lookup_tid(t, tid);
1557 	if (unlikely(!csk)) {
1558 		pr_err("can't find connection for tid %u.\n", tid);
1559 		goto rel_skb;
1560 	}
1561 	cnp = csk->cnp;
1562 
1563 	pr_debug("%s: csk %p; tid %u; cnp %p\n",
1564 		 __func__, csk, tid, cnp);
1565 
1566 	csk->write_seq = snd_isn;
1567 	csk->snd_una = snd_isn;
1568 	csk->snd_nxt = snd_isn;
1569 
1570 	csk->rcv_nxt = rcv_isn;
1571 
1572 	if (csk->rcv_win > (RCV_BUFSIZ_M << 10))
1573 		csk->rx_credits = (csk->rcv_win - (RCV_BUFSIZ_M << 10));
1574 
1575 	csk->snd_wscale = TCPOPT_SND_WSCALE_G(tcp_opt);
1576 	cxgbit_set_emss(csk, tcp_opt);
1577 	dst_confirm(csk->dst);
1578 	csk->com.state = CSK_STATE_ESTABLISHED;
1579 	spin_lock_bh(&cnp->np_accept_lock);
1580 	list_add_tail(&csk->accept_node, &cnp->np_accept_list);
1581 	spin_unlock_bh(&cnp->np_accept_lock);
1582 	complete(&cnp->accept_comp);
1583 rel_skb:
1584 	__kfree_skb(skb);
1585 }
1586 
1587 static void cxgbit_queue_rx_skb(struct cxgbit_sock *csk, struct sk_buff *skb)
1588 {
1589 	cxgbit_skcb_flags(skb) = 0;
1590 	spin_lock_bh(&csk->rxq.lock);
1591 	__skb_queue_tail(&csk->rxq, skb);
1592 	spin_unlock_bh(&csk->rxq.lock);
1593 	wake_up(&csk->waitq);
1594 }
1595 
1596 static void cxgbit_peer_close(struct cxgbit_sock *csk, struct sk_buff *skb)
1597 {
1598 	pr_debug("%s: csk %p; tid %u; state %d\n",
1599 		 __func__, csk, csk->tid, csk->com.state);
1600 
1601 	switch (csk->com.state) {
1602 	case CSK_STATE_ESTABLISHED:
1603 		csk->com.state = CSK_STATE_CLOSING;
1604 		cxgbit_queue_rx_skb(csk, skb);
1605 		return;
1606 	case CSK_STATE_CLOSING:
1607 		/* simultaneous close */
1608 		csk->com.state = CSK_STATE_MORIBUND;
1609 		break;
1610 	case CSK_STATE_MORIBUND:
1611 		csk->com.state = CSK_STATE_DEAD;
1612 		cxgbit_put_csk(csk);
1613 		break;
1614 	case CSK_STATE_ABORTING:
1615 		break;
1616 	default:
1617 		pr_info("%s: cpl_peer_close in bad state %d\n",
1618 			__func__, csk->com.state);
1619 	}
1620 
1621 	__kfree_skb(skb);
1622 }
1623 
1624 static void cxgbit_close_con_rpl(struct cxgbit_sock *csk, struct sk_buff *skb)
1625 {
1626 	pr_debug("%s: csk %p; tid %u; state %d\n",
1627 		 __func__, csk, csk->tid, csk->com.state);
1628 
1629 	switch (csk->com.state) {
1630 	case CSK_STATE_CLOSING:
1631 		csk->com.state = CSK_STATE_MORIBUND;
1632 		break;
1633 	case CSK_STATE_MORIBUND:
1634 		csk->com.state = CSK_STATE_DEAD;
1635 		cxgbit_put_csk(csk);
1636 		break;
1637 	case CSK_STATE_ABORTING:
1638 	case CSK_STATE_DEAD:
1639 		break;
1640 	default:
1641 		pr_info("%s: cpl_close_con_rpl in bad state %d\n",
1642 			__func__, csk->com.state);
1643 	}
1644 
1645 	__kfree_skb(skb);
1646 }
1647 
1648 static void cxgbit_abort_req_rss(struct cxgbit_sock *csk, struct sk_buff *skb)
1649 {
1650 	struct cpl_abort_req_rss *hdr = cplhdr(skb);
1651 	unsigned int tid = GET_TID(hdr);
1652 	struct sk_buff *rpl_skb;
1653 	bool release = false;
1654 	bool wakeup_thread = false;
1655 	u32 len = roundup(sizeof(struct cpl_abort_rpl), 16);
1656 
1657 	pr_debug("%s: csk %p; tid %u; state %d\n",
1658 		 __func__, csk, tid, csk->com.state);
1659 
1660 	if (cxgb_is_neg_adv(hdr->status)) {
1661 		pr_err("%s: got neg advise %d on tid %u\n",
1662 		       __func__, hdr->status, tid);
1663 		goto rel_skb;
1664 	}
1665 
1666 	switch (csk->com.state) {
1667 	case CSK_STATE_CONNECTING:
1668 	case CSK_STATE_MORIBUND:
1669 		csk->com.state = CSK_STATE_DEAD;
1670 		release = true;
1671 		break;
1672 	case CSK_STATE_ESTABLISHED:
1673 		csk->com.state = CSK_STATE_DEAD;
1674 		wakeup_thread = true;
1675 		break;
1676 	case CSK_STATE_CLOSING:
1677 		csk->com.state = CSK_STATE_DEAD;
1678 		if (!csk->conn)
1679 			release = true;
1680 		break;
1681 	case CSK_STATE_ABORTING:
1682 		break;
1683 	default:
1684 		pr_info("%s: cpl_abort_req_rss in bad state %d\n",
1685 			__func__, csk->com.state);
1686 		csk->com.state = CSK_STATE_DEAD;
1687 	}
1688 
1689 	__skb_queue_purge(&csk->txq);
1690 
1691 	if (!test_and_set_bit(CSK_TX_DATA_SENT, &csk->com.flags))
1692 		cxgbit_send_tx_flowc_wr(csk);
1693 
1694 	rpl_skb = __skb_dequeue(&csk->skbq);
1695 
1696 	cxgb_mk_abort_rpl(rpl_skb, len, csk->tid, csk->txq_idx);
1697 	cxgbit_ofld_send(csk->com.cdev, rpl_skb);
1698 
1699 	if (wakeup_thread) {
1700 		cxgbit_queue_rx_skb(csk, skb);
1701 		return;
1702 	}
1703 
1704 	if (release)
1705 		cxgbit_put_csk(csk);
1706 rel_skb:
1707 	__kfree_skb(skb);
1708 }
1709 
1710 static void cxgbit_abort_rpl_rss(struct cxgbit_sock *csk, struct sk_buff *skb)
1711 {
1712 	pr_debug("%s: csk %p; tid %u; state %d\n",
1713 		 __func__, csk, csk->tid, csk->com.state);
1714 
1715 	switch (csk->com.state) {
1716 	case CSK_STATE_ABORTING:
1717 		csk->com.state = CSK_STATE_DEAD;
1718 		cxgbit_put_csk(csk);
1719 		break;
1720 	default:
1721 		pr_info("%s: cpl_abort_rpl_rss in state %d\n",
1722 			__func__, csk->com.state);
1723 	}
1724 
1725 	__kfree_skb(skb);
1726 }
1727 
1728 static bool cxgbit_credit_err(const struct cxgbit_sock *csk)
1729 {
1730 	const struct sk_buff *skb = csk->wr_pending_head;
1731 	u32 credit = 0;
1732 
1733 	if (unlikely(csk->wr_cred > csk->wr_max_cred)) {
1734 		pr_err("csk 0x%p, tid %u, credit %u > %u\n",
1735 		       csk, csk->tid, csk->wr_cred, csk->wr_max_cred);
1736 		return true;
1737 	}
1738 
1739 	while (skb) {
1740 		credit += (__force u32)skb->csum;
1741 		skb = cxgbit_skcb_tx_wr_next(skb);
1742 	}
1743 
1744 	if (unlikely((csk->wr_cred + credit) != csk->wr_max_cred)) {
1745 		pr_err("csk 0x%p, tid %u, credit %u + %u != %u.\n",
1746 		       csk, csk->tid, csk->wr_cred,
1747 		       credit, csk->wr_max_cred);
1748 
1749 		return true;
1750 	}
1751 
1752 	return false;
1753 }
1754 
1755 static void cxgbit_fw4_ack(struct cxgbit_sock *csk, struct sk_buff *skb)
1756 {
1757 	struct cpl_fw4_ack *rpl = (struct cpl_fw4_ack *)cplhdr(skb);
1758 	u32 credits = rpl->credits;
1759 	u32 snd_una = ntohl(rpl->snd_una);
1760 
1761 	csk->wr_cred += credits;
1762 	if (csk->wr_una_cred > (csk->wr_max_cred - csk->wr_cred))
1763 		csk->wr_una_cred = csk->wr_max_cred - csk->wr_cred;
1764 
1765 	while (credits) {
1766 		struct sk_buff *p = cxgbit_sock_peek_wr(csk);
1767 		const u32 csum = (__force u32)p->csum;
1768 
1769 		if (unlikely(!p)) {
1770 			pr_err("csk 0x%p,%u, cr %u,%u+%u, empty.\n",
1771 			       csk, csk->tid, credits,
1772 			       csk->wr_cred, csk->wr_una_cred);
1773 			break;
1774 		}
1775 
1776 		if (unlikely(credits < csum)) {
1777 			pr_warn("csk 0x%p,%u, cr %u,%u+%u, < %u.\n",
1778 				csk,  csk->tid,
1779 				credits, csk->wr_cred, csk->wr_una_cred,
1780 				csum);
1781 			p->csum = (__force __wsum)(csum - credits);
1782 			break;
1783 		}
1784 
1785 		cxgbit_sock_dequeue_wr(csk);
1786 		credits -= csum;
1787 		kfree_skb(p);
1788 	}
1789 
1790 	if (unlikely(cxgbit_credit_err(csk))) {
1791 		cxgbit_queue_rx_skb(csk, skb);
1792 		return;
1793 	}
1794 
1795 	if (rpl->seq_vld & CPL_FW4_ACK_FLAGS_SEQVAL) {
1796 		if (unlikely(before(snd_una, csk->snd_una))) {
1797 			pr_warn("csk 0x%p,%u, snd_una %u/%u.",
1798 				csk, csk->tid, snd_una,
1799 				csk->snd_una);
1800 			goto rel_skb;
1801 		}
1802 
1803 		if (csk->snd_una != snd_una) {
1804 			csk->snd_una = snd_una;
1805 			dst_confirm(csk->dst);
1806 			wake_up(&csk->ack_waitq);
1807 		}
1808 	}
1809 
1810 	if (skb_queue_len(&csk->txq))
1811 		cxgbit_push_tx_frames(csk);
1812 
1813 rel_skb:
1814 	__kfree_skb(skb);
1815 }
1816 
1817 static void cxgbit_set_tcb_rpl(struct cxgbit_device *cdev, struct sk_buff *skb)
1818 {
1819 	struct cxgbit_sock *csk;
1820 	struct cpl_set_tcb_rpl *rpl = (struct cpl_set_tcb_rpl *)skb->data;
1821 	unsigned int tid = GET_TID(rpl);
1822 	struct cxgb4_lld_info *lldi = &cdev->lldi;
1823 	struct tid_info *t = lldi->tids;
1824 
1825 	csk = lookup_tid(t, tid);
1826 	if (unlikely(!csk))
1827 		pr_err("can't find connection for tid %u.\n", tid);
1828 	else
1829 		cxgbit_wake_up(&csk->com.wr_wait, __func__, rpl->status);
1830 
1831 	cxgbit_put_csk(csk);
1832 }
1833 
1834 static void cxgbit_rx_data(struct cxgbit_device *cdev, struct sk_buff *skb)
1835 {
1836 	struct cxgbit_sock *csk;
1837 	struct cpl_rx_data *cpl = cplhdr(skb);
1838 	unsigned int tid = GET_TID(cpl);
1839 	struct cxgb4_lld_info *lldi = &cdev->lldi;
1840 	struct tid_info *t = lldi->tids;
1841 
1842 	csk = lookup_tid(t, tid);
1843 	if (unlikely(!csk)) {
1844 		pr_err("can't find conn. for tid %u.\n", tid);
1845 		goto rel_skb;
1846 	}
1847 
1848 	cxgbit_queue_rx_skb(csk, skb);
1849 	return;
1850 rel_skb:
1851 	__kfree_skb(skb);
1852 }
1853 
1854 static void
1855 __cxgbit_process_rx_cpl(struct cxgbit_sock *csk, struct sk_buff *skb)
1856 {
1857 	spin_lock(&csk->lock);
1858 	if (csk->lock_owner) {
1859 		__skb_queue_tail(&csk->backlogq, skb);
1860 		spin_unlock(&csk->lock);
1861 		return;
1862 	}
1863 
1864 	cxgbit_skcb_rx_backlog_fn(skb)(csk, skb);
1865 	spin_unlock(&csk->lock);
1866 }
1867 
1868 static void cxgbit_process_rx_cpl(struct cxgbit_sock *csk, struct sk_buff *skb)
1869 {
1870 	cxgbit_get_csk(csk);
1871 	__cxgbit_process_rx_cpl(csk, skb);
1872 	cxgbit_put_csk(csk);
1873 }
1874 
1875 static void cxgbit_rx_cpl(struct cxgbit_device *cdev, struct sk_buff *skb)
1876 {
1877 	struct cxgbit_sock *csk;
1878 	struct cpl_tx_data *cpl = cplhdr(skb);
1879 	struct cxgb4_lld_info *lldi = &cdev->lldi;
1880 	struct tid_info *t = lldi->tids;
1881 	unsigned int tid = GET_TID(cpl);
1882 	u8 opcode = cxgbit_skcb_rx_opcode(skb);
1883 	bool ref = true;
1884 
1885 	switch (opcode) {
1886 	case CPL_FW4_ACK:
1887 			cxgbit_skcb_rx_backlog_fn(skb) = cxgbit_fw4_ack;
1888 			ref = false;
1889 			break;
1890 	case CPL_PEER_CLOSE:
1891 			cxgbit_skcb_rx_backlog_fn(skb) = cxgbit_peer_close;
1892 			break;
1893 	case CPL_CLOSE_CON_RPL:
1894 			cxgbit_skcb_rx_backlog_fn(skb) = cxgbit_close_con_rpl;
1895 			break;
1896 	case CPL_ABORT_REQ_RSS:
1897 			cxgbit_skcb_rx_backlog_fn(skb) = cxgbit_abort_req_rss;
1898 			break;
1899 	case CPL_ABORT_RPL_RSS:
1900 			cxgbit_skcb_rx_backlog_fn(skb) = cxgbit_abort_rpl_rss;
1901 			break;
1902 	default:
1903 		goto rel_skb;
1904 	}
1905 
1906 	csk = lookup_tid(t, tid);
1907 	if (unlikely(!csk)) {
1908 		pr_err("can't find conn. for tid %u.\n", tid);
1909 		goto rel_skb;
1910 	}
1911 
1912 	if (ref)
1913 		cxgbit_process_rx_cpl(csk, skb);
1914 	else
1915 		__cxgbit_process_rx_cpl(csk, skb);
1916 
1917 	return;
1918 rel_skb:
1919 	__kfree_skb(skb);
1920 }
1921 
1922 cxgbit_cplhandler_func cxgbit_cplhandlers[NUM_CPL_CMDS] = {
1923 	[CPL_PASS_OPEN_RPL]	= cxgbit_pass_open_rpl,
1924 	[CPL_CLOSE_LISTSRV_RPL] = cxgbit_close_listsrv_rpl,
1925 	[CPL_PASS_ACCEPT_REQ]	= cxgbit_pass_accept_req,
1926 	[CPL_PASS_ESTABLISH]	= cxgbit_pass_establish,
1927 	[CPL_SET_TCB_RPL]	= cxgbit_set_tcb_rpl,
1928 	[CPL_RX_DATA]		= cxgbit_rx_data,
1929 	[CPL_FW4_ACK]		= cxgbit_rx_cpl,
1930 	[CPL_PEER_CLOSE]	= cxgbit_rx_cpl,
1931 	[CPL_CLOSE_CON_RPL]	= cxgbit_rx_cpl,
1932 	[CPL_ABORT_REQ_RSS]	= cxgbit_rx_cpl,
1933 	[CPL_ABORT_RPL_RSS]	= cxgbit_rx_cpl,
1934 };
1935