2 * Copyright (c) 2016 Chelsio Communications, Inc.
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.
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>
17 #include <linux/tcp.h>
18 #include <linux/if_vlan.h>
20 #include <net/neighbour.h>
21 #include <net/netevent.h>
22 #include <net/route.h>
24 #include <net/ip6_route.h>
25 #include <net/addrconf.h>
27 #include <libcxgb_cm.h>
31 static void cxgbit_init_wr_wait(struct cxgbit_wr_wait
*wr_waitp
)
34 reinit_completion(&wr_waitp
->completion
);
38 cxgbit_wake_up(struct cxgbit_wr_wait
*wr_waitp
, const char *func
, u8 ret
)
40 if (ret
== CPL_ERR_NONE
)
46 pr_err("%s: err:%u", func
, ret
);
48 complete(&wr_waitp
->completion
);
52 cxgbit_wait_for_reply(struct cxgbit_device
*cdev
,
53 struct cxgbit_wr_wait
*wr_waitp
, u32 tid
, u32 timeout
,
58 if (!test_bit(CDEV_STATE_UP
, &cdev
->flags
)) {
63 ret
= wait_for_completion_timeout(&wr_waitp
->completion
, timeout
* HZ
);
65 pr_info("%s - Device %s not responding tid %u\n",
66 func
, pci_name(cdev
->lldi
.pdev
), tid
);
67 wr_waitp
->ret
= -ETIMEDOUT
;
71 pr_info("%s: FW reply %d tid %u\n",
72 pci_name(cdev
->lldi
.pdev
), wr_waitp
->ret
, tid
);
76 static int cxgbit_np_hashfn(const struct cxgbit_np
*cnp
)
78 return ((unsigned long)cnp
>> 10) & (NP_INFO_HASH_SIZE
- 1);
81 static struct np_info
*
82 cxgbit_np_hash_add(struct cxgbit_device
*cdev
, struct cxgbit_np
*cnp
,
85 struct np_info
*p
= kzalloc(sizeof(*p
), GFP_KERNEL
);
88 int bucket
= cxgbit_np_hashfn(cnp
);
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
);
102 cxgbit_np_hash_find(struct cxgbit_device
*cdev
, struct cxgbit_np
*cnp
)
104 int stid
= -1, bucket
= cxgbit_np_hashfn(cnp
);
107 spin_lock(&cdev
->np_lock
);
108 for (p
= cdev
->np_hash_tab
[bucket
]; p
; p
= p
->next
) {
114 spin_unlock(&cdev
->np_lock
);
119 static int cxgbit_np_hash_del(struct cxgbit_device
*cdev
, struct cxgbit_np
*cnp
)
121 int stid
= -1, bucket
= cxgbit_np_hashfn(cnp
);
122 struct np_info
*p
, **prev
= &cdev
->np_hash_tab
[bucket
];
124 spin_lock(&cdev
->np_lock
);
125 for (p
= *prev
; p
; prev
= &p
->next
, p
= p
->next
) {
133 spin_unlock(&cdev
->np_lock
);
138 void _cxgbit_free_cnp(struct kref
*kref
)
140 struct cxgbit_np
*cnp
;
142 cnp
= container_of(kref
, struct cxgbit_np
, kref
);
147 cxgbit_create_server6(struct cxgbit_device
*cdev
, unsigned int stid
,
148 struct cxgbit_np
*cnp
)
150 struct sockaddr_in6
*sin6
= (struct sockaddr_in6
*)
151 &cnp
->com
.local_addr
;
155 pr_debug("%s: dev = %s; stid = %u; sin6_port = %u\n",
156 __func__
, cdev
->lldi
.ports
[0]->name
, stid
, sin6
->sin6_port
);
158 addr_type
= ipv6_addr_type((const struct in6_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);
164 pr_err("Unable to find clip table entry. laddr %pI6. Error:%d.\n",
165 sin6
->sin6_addr
.s6_addr
, ret
);
171 cxgbit_init_wr_wait(&cnp
->com
.wr_wait
);
173 ret
= cxgb4_create_server6(cdev
->lldi
.ports
[0],
174 stid
, &sin6
->sin6_addr
,
176 cdev
->lldi
.rxq_ids
[0]);
178 ret
= cxgbit_wait_for_reply(cdev
, &cnp
->com
.wr_wait
,
181 ret
= net_xmit_errno(ret
);
186 if (ret
!= -ETIMEDOUT
)
187 cxgb4_clip_release(cdev
->lldi
.ports
[0],
188 (const u32
*)&sin6
->sin6_addr
.s6_addr
, 1);
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
));
199 cxgbit_create_server4(struct cxgbit_device
*cdev
, unsigned int stid
,
200 struct cxgbit_np
*cnp
)
202 struct sockaddr_in
*sin
= (struct sockaddr_in
*)
203 &cnp
->com
.local_addr
;
206 pr_debug("%s: dev = %s; stid = %u; sin_port = %u\n",
207 __func__
, cdev
->lldi
.ports
[0]->name
, stid
, sin
->sin_port
);
210 cxgbit_init_wr_wait(&cnp
->com
.wr_wait
);
212 ret
= cxgb4_create_server(cdev
->lldi
.ports
[0],
213 stid
, sin
->sin_addr
.s_addr
,
215 cdev
->lldi
.rxq_ids
[0]);
217 ret
= cxgbit_wait_for_reply(cdev
,
221 ret
= net_xmit_errno(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
));
231 struct cxgbit_device
*cxgbit_find_device(struct net_device
*ndev
, u8
*port_id
)
233 struct cxgbit_device
*cdev
;
236 list_for_each_entry(cdev
, &cdev_list_head
, list
) {
237 struct cxgb4_lld_info
*lldi
= &cdev
->lldi
;
239 for (i
= 0; i
< lldi
->nports
; i
++) {
240 if (lldi
->ports
[i
] == ndev
) {
251 static struct net_device
*cxgbit_get_real_dev(struct net_device
*ndev
)
253 if (ndev
->priv_flags
& IFF_BONDING
) {
254 pr_err("Bond devices are not supported. Interface:%s\n",
259 if (is_vlan_dev(ndev
))
260 return vlan_dev_real_dev(ndev
);
265 static struct net_device
*cxgbit_ipv4_netdev(__be32 saddr
)
267 struct net_device
*ndev
;
269 ndev
= __ip_dev_find(&init_net
, saddr
, false);
273 return cxgbit_get_real_dev(ndev
);
276 static struct net_device
*cxgbit_ipv6_netdev(struct in6_addr
*addr6
)
278 struct net_device
*ndev
= NULL
;
281 if (IS_ENABLED(CONFIG_IPV6
)) {
282 for_each_netdev_rcu(&init_net
, ndev
)
283 if (ipv6_chk_addr(&init_net
, addr6
, ndev
, 1)) {
290 return cxgbit_get_real_dev(ndev
);
293 static struct cxgbit_device
*cxgbit_find_np_cdev(struct cxgbit_np
*cnp
)
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
;
301 if (ss_family
== AF_INET
) {
302 struct sockaddr_in
*sin
;
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
;
309 sin6
= (struct sockaddr_in6
*)sockaddr
;
310 ndev
= cxgbit_ipv6_netdev(&sin6
->sin6_addr
);
315 cdev
= cxgbit_find_device(ndev
, NULL
);
321 static bool cxgbit_inaddr_any(struct cxgbit_np
*cnp
)
323 struct sockaddr_storage
*sockaddr
= &cnp
->com
.local_addr
;
324 int ss_family
= sockaddr
->ss_family
;
327 if (ss_family
== AF_INET
) {
328 struct sockaddr_in
*sin
;
330 sin
= (struct sockaddr_in
*)sockaddr
;
331 if (sin
->sin_addr
.s_addr
== htonl(INADDR_ANY
))
333 } else if (ss_family
== AF_INET6
) {
334 struct sockaddr_in6
*sin6
;
336 sin6
= (struct sockaddr_in6
*)sockaddr
;
337 addr_type
= ipv6_addr_type((const struct in6_addr
*)
339 if (addr_type
== IPV6_ADDR_ANY
)
346 __cxgbit_setup_cdev_np(struct cxgbit_device
*cdev
, struct cxgbit_np
*cnp
)
349 int ss_family
= cnp
->com
.local_addr
.ss_family
;
351 if (!test_bit(CDEV_STATE_UP
, &cdev
->flags
))
354 stid
= cxgb4_alloc_stid(cdev
->lldi
.tids
, ss_family
, cnp
);
358 if (!cxgbit_np_hash_add(cdev
, cnp
, stid
)) {
359 cxgb4_free_stid(cdev
->lldi
.tids
, stid
, ss_family
);
363 if (ss_family
== AF_INET
)
364 ret
= cxgbit_create_server4(cdev
, stid
, cnp
);
366 ret
= cxgbit_create_server6(cdev
, stid
, cnp
);
369 if (ret
!= -ETIMEDOUT
)
370 cxgb4_free_stid(cdev
->lldi
.tids
, stid
,
372 cxgbit_np_hash_del(cdev
, cnp
);
378 static int cxgbit_setup_cdev_np(struct cxgbit_np
*cnp
)
380 struct cxgbit_device
*cdev
;
383 mutex_lock(&cdev_list_lock
);
384 cdev
= cxgbit_find_np_cdev(cnp
);
388 if (cxgbit_np_hash_find(cdev
, cnp
) >= 0)
391 if (__cxgbit_setup_cdev_np(cdev
, cnp
))
394 cnp
->com
.cdev
= cdev
;
397 mutex_unlock(&cdev_list_lock
);
401 static int cxgbit_setup_all_np(struct cxgbit_np
*cnp
)
403 struct cxgbit_device
*cdev
;
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
);
415 list_for_each_entry(cdev
, &cdev_list_head
, list
) {
416 ret
= __cxgbit_setup_cdev_np(cdev
, cnp
);
417 if (ret
== -ETIMEDOUT
)
423 mutex_unlock(&cdev_list_lock
);
425 return count
? 0 : -1;
428 int cxgbit_setup_np(struct iscsi_np
*np
, struct sockaddr_storage
*ksockaddr
)
430 struct cxgbit_np
*cnp
;
433 if ((ksockaddr
->ss_family
!= AF_INET
) &&
434 (ksockaddr
->ss_family
!= AF_INET6
))
437 cnp
= kzalloc(sizeof(*cnp
), GFP_KERNEL
);
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
));
453 cnp
->com
.cdev
= NULL
;
455 if (cxgbit_inaddr_any(cnp
))
456 ret
= cxgbit_setup_all_np(cnp
);
458 ret
= cxgbit_setup_cdev_np(cnp
);
465 np
->np_context
= cnp
;
466 cnp
->com
.state
= CSK_STATE_LISTEN
;
471 cxgbit_set_conn_info(struct iscsi_np
*np
, struct iscsi_conn
*conn
,
472 struct cxgbit_sock
*csk
)
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
;
479 int cxgbit_accept_np(struct iscsi_np
*np
, struct iscsi_conn
*conn
)
481 struct cxgbit_np
*cnp
= np
->np_context
;
482 struct cxgbit_sock
*csk
;
486 ret
= wait_for_completion_interruptible(&cnp
->accept_comp
);
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
);
494 * No point in stalling here when np_thread
495 * is in state RESET/SHUTDOWN/EXIT - bail
499 spin_unlock_bh(&np
->np_thread_lock
);
501 spin_lock_bh(&cnp
->np_accept_lock
);
502 if (list_empty(&cnp
->np_accept_list
)) {
503 spin_unlock_bh(&cnp
->np_accept_lock
);
507 csk
= list_first_entry(&cnp
->np_accept_list
,
511 list_del_init(&csk
->accept_node
);
512 spin_unlock_bh(&cnp
->np_accept_lock
);
516 cxgbit_set_conn_info(np
, conn
, csk
);
521 __cxgbit_free_cdev_np(struct cxgbit_device
*cdev
, struct cxgbit_np
*cnp
)
526 stid
= cxgbit_np_hash_del(cdev
, cnp
);
529 if (!test_bit(CDEV_STATE_UP
, &cdev
->flags
))
532 if (cnp
->np
->np_sockaddr
.ss_family
== AF_INET6
)
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
);
541 ret
= net_xmit_errno(ret
);
548 ret
= cxgbit_wait_for_reply(cdev
, &cnp
->com
.wr_wait
,
550 if (ret
== -ETIMEDOUT
)
553 if (ipv6
&& cnp
->com
.cdev
) {
554 struct sockaddr_in6
*sin6
;
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
,
562 cxgb4_free_stid(cdev
->lldi
.tids
, stid
,
563 cnp
->com
.local_addr
.ss_family
);
567 static void cxgbit_free_all_np(struct cxgbit_np
*cnp
)
569 struct cxgbit_device
*cdev
;
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
)
578 mutex_unlock(&cdev_list_lock
);
581 static void cxgbit_free_cdev_np(struct cxgbit_np
*cnp
)
583 struct cxgbit_device
*cdev
;
586 mutex_lock(&cdev_list_lock
);
587 list_for_each_entry(cdev
, &cdev_list_head
, list
) {
588 if (cdev
== cnp
->com
.cdev
) {
596 __cxgbit_free_cdev_np(cdev
, cnp
);
598 mutex_unlock(&cdev_list_lock
);
601 void cxgbit_free_np(struct iscsi_np
*np
)
603 struct cxgbit_np
*cnp
= np
->np_context
;
605 cnp
->com
.state
= CSK_STATE_DEAD
;
607 cxgbit_free_cdev_np(cnp
);
609 cxgbit_free_all_np(cnp
);
611 np
->np_context
= NULL
;
615 static void cxgbit_send_halfclose(struct cxgbit_sock
*csk
)
618 u32 len
= roundup(sizeof(struct cpl_close_con_req
), 16);
620 skb
= alloc_skb(len
, GFP_ATOMIC
);
624 cxgb_mk_close_con_req(skb
, len
, csk
->tid
, csk
->txq_idx
,
627 cxgbit_skcb_flags(skb
) |= SKCBF_TX_FLAG_COMPL
;
628 __skb_queue_tail(&csk
->txq
, skb
);
629 cxgbit_push_tx_frames(csk
);
632 static void cxgbit_arp_failure_discard(void *handle
, struct sk_buff
*skb
)
634 pr_debug("%s cxgbit_device %p\n", __func__
, handle
);
638 static void cxgbit_abort_arp_failure(void *handle
, struct sk_buff
*skb
)
640 struct cxgbit_device
*cdev
= handle
;
641 struct cpl_abort_req
*req
= cplhdr(skb
);
643 pr_debug("%s cdev %p\n", __func__
, cdev
);
644 req
->cmd
= CPL_ABORT_NO_RST
;
645 cxgbit_ofld_send(cdev
, skb
);
648 static int cxgbit_send_abort_req(struct cxgbit_sock
*csk
)
651 u32 len
= roundup(sizeof(struct cpl_abort_req
), 16);
653 pr_debug("%s: csk %p tid %u; state %d\n",
654 __func__
, csk
, csk
->tid
, csk
->com
.state
);
656 __skb_queue_purge(&csk
->txq
);
658 if (!test_and_set_bit(CSK_TX_DATA_SENT
, &csk
->com
.flags
))
659 cxgbit_send_tx_flowc_wr(csk
);
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
);
665 return cxgbit_l2t_send(csk
->com
.cdev
, skb
, csk
->l2t
);
668 void cxgbit_free_conn(struct iscsi_conn
*conn
)
670 struct cxgbit_sock
*csk
= conn
->context
;
671 bool release
= false;
673 pr_debug("%s: state %d\n",
674 __func__
, csk
->com
.state
);
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
);
683 csk
->com
.state
= CSK_STATE_ABORTING
;
684 cxgbit_send_abort_req(csk
);
687 case CSK_STATE_CLOSING
:
688 csk
->com
.state
= CSK_STATE_MORIBUND
;
689 cxgbit_send_halfclose(csk
);
695 pr_err("%s: csk %p; state %d\n",
696 __func__
, csk
, csk
->com
.state
);
698 spin_unlock_bh(&csk
->lock
);
704 static void cxgbit_set_emss(struct cxgbit_sock
*csk
, u16 opt
)
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);
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
);
722 static void cxgbit_free_skb(struct cxgbit_sock
*csk
)
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
);
732 while ((skb
= cxgbit_sock_dequeue_wr(csk
)))
735 __kfree_skb(csk
->lro_hskb
);
738 void _cxgbit_free_csk(struct kref
*kref
)
740 struct cxgbit_sock
*csk
;
741 struct cxgbit_device
*cdev
;
743 csk
= container_of(kref
, struct cxgbit_sock
, kref
);
745 pr_debug("%s csk %p state %d\n", __func__
, csk
, csk
->com
.state
);
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],
752 &sin6
->sin6_addr
.s6_addr
, 1);
755 cxgb4_remove_tid(csk
->com
.cdev
->lldi
.tids
, 0, csk
->tid
);
756 dst_release(csk
->dst
);
757 cxgb4_l2t_release(csk
->l2t
);
759 cdev
= csk
->com
.cdev
;
760 spin_lock_bh(&cdev
->cskq
.lock
);
761 list_del(&csk
->list
);
762 spin_unlock_bh(&cdev
->cskq
.lock
);
764 cxgbit_free_skb(csk
);
765 cxgbit_put_cdev(cdev
);
770 static void cxgbit_set_tcp_window(struct cxgbit_sock
*csk
, struct port_info
*pi
)
772 unsigned int linkspeed
;
775 linkspeed
= pi
->link_cfg
.speed
;
776 scale
= linkspeed
/ SPEED_10000
;
778 #define CXGBIT_10G_RCV_WIN (256 * 1024)
779 csk
->rcv_win
= CXGBIT_10G_RCV_WIN
;
781 csk
->rcv_win
*= scale
;
783 #define CXGBIT_10G_SND_WIN (256 * 1024)
784 csk
->snd_win
= CXGBIT_10G_SND_WIN
;
786 csk
->snd_win
*= scale
;
788 pr_debug("%s snd_win %d rcv_win %d\n",
789 __func__
, csk
->snd_win
, csk
->rcv_win
);
792 #ifdef CONFIG_CHELSIO_T4_DCB
793 static u8
cxgbit_get_iscsi_dcb_state(struct net_device
*ndev
)
795 return ndev
->dcbnl_ops
->getstate(ndev
);
798 static int cxgbit_select_priority(int pri_mask
)
803 return (ffs(pri_mask
) - 1);
806 static u8
cxgbit_get_iscsi_dcb_priority(struct net_device
*ndev
, u16 local_port
)
811 struct dcb_app iscsi_dcb_app
= {
812 .protocol
= local_port
815 ret
= (int)ndev
->dcbnl_ops
->getcap(ndev
, DCB_CAP_ATTR_DCBX
, &caps
);
820 if (caps
& DCB_CAP_DCBX_VER_IEEE
) {
821 iscsi_dcb_app
.selector
= IEEE_8021QAZ_APP_SEL_ANY
;
823 ret
= dcb_ieee_getapp_mask(ndev
, &iscsi_dcb_app
);
825 } else if (caps
& DCB_CAP_DCBX_VER_CEE
) {
826 iscsi_dcb_app
.selector
= DCB_APP_IDTYPE_PORTNUM
;
828 ret
= dcb_getapp(ndev
, &iscsi_dcb_app
);
831 pr_info("iSCSI priority is set to %u\n", cxgbit_select_priority(ret
));
833 return cxgbit_select_priority(ret
);
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
)
844 struct net_device
*ndev
;
845 u16 rxq_idx
, port_id
;
846 #ifdef CONFIG_CHELSIO_T4_DCB
850 n
= dst_neigh_lookup(dst
, peer_ip
);
856 if (n
->dev
->flags
& IFF_LOOPBACK
) {
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
);
869 csk
->l2t
= cxgb4_l2t_get(cdev
->lldi
.l2t
,
873 csk
->mtu
= ndev
->mtu
;
874 csk
->tx_chan
= cxgb4_port_chan(ndev
);
875 csk
->smac_idx
= (cxgb4_port_viid(ndev
) & 0x7F) << 1;
876 step
= cdev
->lldi
.ntxq
/
878 csk
->txq_idx
= cxgb4_port_idx(ndev
) * step
;
879 step
= cdev
->lldi
.nrxq
/
881 csk
->ctrlq_idx
= cxgb4_port_idx(ndev
);
882 csk
->rss_qid
= cdev
->lldi
.rxq_ids
[
883 cxgb4_port_idx(ndev
) * step
];
884 csk
->port_id
= cxgb4_port_idx(ndev
);
885 cxgbit_set_tcp_window(csk
,
886 (struct port_info
*)netdev_priv(ndev
));
888 ndev
= cxgbit_get_real_dev(n
->dev
);
894 #ifdef CONFIG_CHELSIO_T4_DCB
895 if (cxgbit_get_iscsi_dcb_state(ndev
))
896 priority
= cxgbit_get_iscsi_dcb_priority(ndev
,
899 csk
->dcb_priority
= priority
;
901 csk
->l2t
= cxgb4_l2t_get(cdev
->lldi
.l2t
, n
, ndev
, priority
);
903 csk
->l2t
= cxgb4_l2t_get(cdev
->lldi
.l2t
, n
, ndev
, 0);
907 port_id
= cxgb4_port_idx(ndev
);
908 csk
->mtu
= dst_mtu(dst
);
909 csk
->tx_chan
= cxgb4_port_chan(ndev
);
910 csk
->smac_idx
= (cxgb4_port_viid(ndev
) & 0x7F) << 1;
911 step
= cdev
->lldi
.ntxq
/
913 csk
->txq_idx
= (port_id
* step
) +
914 (cdev
->selectq
[port_id
][0]++ % step
);
915 csk
->ctrlq_idx
= cxgb4_port_idx(ndev
);
916 step
= cdev
->lldi
.nrxq
/
918 rxq_idx
= (port_id
* step
) +
919 (cdev
->selectq
[port_id
][1]++ % step
);
920 csk
->rss_qid
= cdev
->lldi
.rxq_ids
[rxq_idx
];
921 csk
->port_id
= port_id
;
922 cxgbit_set_tcp_window(csk
,
923 (struct port_info
*)netdev_priv(ndev
));
932 int cxgbit_ofld_send(struct cxgbit_device
*cdev
, struct sk_buff
*skb
)
936 if (!test_bit(CDEV_STATE_UP
, &cdev
->flags
)) {
938 pr_err("%s - device not up - dropping\n", __func__
);
942 ret
= cxgb4_ofld_send(cdev
->lldi
.ports
[0], skb
);
945 return ret
< 0 ? ret
: 0;
948 static void cxgbit_release_tid(struct cxgbit_device
*cdev
, u32 tid
)
950 u32 len
= roundup(sizeof(struct cpl_tid_release
), 16);
953 skb
= alloc_skb(len
, GFP_ATOMIC
);
957 cxgb_mk_tid_release(skb
, len
, tid
, 0);
958 cxgbit_ofld_send(cdev
, skb
);
962 cxgbit_l2t_send(struct cxgbit_device
*cdev
, struct sk_buff
*skb
,
963 struct l2t_entry
*l2e
)
967 if (!test_bit(CDEV_STATE_UP
, &cdev
->flags
)) {
969 pr_err("%s - device not up - dropping\n", __func__
);
973 ret
= cxgb4_l2t_send(cdev
->lldi
.ports
[0], skb
, l2e
);
976 return ret
< 0 ? ret
: 0;
979 static void cxgbit_send_rx_credits(struct cxgbit_sock
*csk
, struct sk_buff
*skb
)
981 if (csk
->com
.state
!= CSK_STATE_ESTABLISHED
) {
986 cxgbit_ofld_send(csk
->com
.cdev
, skb
);
990 * CPL connection rx data ack: host ->
991 * Send RX credits through an RX_DATA_ACK CPL message.
992 * Returns the number of credits sent.
994 int cxgbit_rx_data_ack(struct cxgbit_sock
*csk
)
997 u32 len
= roundup(sizeof(struct cpl_rx_data_ack
), 16);
1000 skb
= alloc_skb(len
, GFP_KERNEL
);
1004 credit_dack
= RX_DACK_CHANGE_F
| RX_DACK_MODE_V(1) |
1005 RX_CREDITS_V(csk
->rx_credits
);
1007 cxgb_mk_rx_data_ack(skb
, len
, csk
->tid
, csk
->ctrlq_idx
,
1010 csk
->rx_credits
= 0;
1012 spin_lock_bh(&csk
->lock
);
1013 if (csk
->lock_owner
) {
1014 cxgbit_skcb_rx_backlog_fn(skb
) = cxgbit_send_rx_credits
;
1015 __skb_queue_tail(&csk
->backlogq
, skb
);
1016 spin_unlock_bh(&csk
->lock
);
1020 cxgbit_send_rx_credits(csk
, skb
);
1021 spin_unlock_bh(&csk
->lock
);
1026 #define FLOWC_WR_NPARAMS_MIN 9
1027 #define FLOWC_WR_NPARAMS_MAX 11
1028 static int cxgbit_alloc_csk_skb(struct cxgbit_sock
*csk
)
1030 struct sk_buff
*skb
;
1034 flowclen
= offsetof(struct fw_flowc_wr
,
1035 mnemval
[FLOWC_WR_NPARAMS_MAX
]);
1037 len
= max_t(u32
, sizeof(struct cpl_abort_req
),
1038 sizeof(struct cpl_abort_rpl
));
1040 len
= max(len
, flowclen
);
1041 len
= roundup(len
, 16);
1043 for (i
= 0; i
< 3; i
++) {
1044 skb
= alloc_skb(len
, GFP_ATOMIC
);
1047 __skb_queue_tail(&csk
->skbq
, skb
);
1050 skb
= alloc_skb(LRO_SKB_MIN_HEADROOM
, GFP_ATOMIC
);
1054 memset(skb
->data
, 0, LRO_SKB_MIN_HEADROOM
);
1055 csk
->lro_hskb
= skb
;
1059 __skb_queue_purge(&csk
->skbq
);
1064 cxgbit_pass_accept_rpl(struct cxgbit_sock
*csk
, struct cpl_pass_accept_req
*req
)
1066 struct sk_buff
*skb
;
1067 const struct tcphdr
*tcph
;
1068 struct cpl_t5_pass_accept_rpl
*rpl5
;
1069 unsigned int len
= roundup(sizeof(*rpl5
), 16);
1070 unsigned int mtu_idx
;
1076 pr_debug("%s csk %p tid %u\n", __func__
, csk
, csk
->tid
);
1078 skb
= alloc_skb(len
, GFP_ATOMIC
);
1080 cxgbit_put_csk(csk
);
1084 rpl5
= (struct cpl_t5_pass_accept_rpl
*)__skb_put(skb
, len
);
1085 memset(rpl5
, 0, len
);
1087 INIT_TP_WR(rpl5
, csk
->tid
);
1088 OPCODE_TID(rpl5
) = cpu_to_be32(MK_OPCODE_TID(CPL_PASS_ACCEPT_RPL
,
1090 cxgb_best_mtu(csk
->com
.cdev
->lldi
.mtus
, csk
->mtu
, &mtu_idx
,
1092 (csk
->com
.remote_addr
.ss_family
== AF_INET
) ? 0 : 1);
1093 wscale
= cxgb_compute_wscale(csk
->rcv_win
);
1095 * Specify the largest window that will fit in opt0. The
1096 * remainder will be specified in the rx_data_ack.
1098 win
= csk
->rcv_win
>> 10;
1099 if (win
> RCV_BUFSIZ_M
)
1101 opt0
= TCAM_BYPASS_F
|
1102 WND_SCALE_V(wscale
) |
1103 MSS_IDX_V(mtu_idx
) |
1104 L2T_IDX_V(csk
->l2t
->idx
) |
1105 TX_CHAN_V(csk
->tx_chan
) |
1106 SMAC_SEL_V(csk
->smac_idx
) |
1107 DSCP_V(csk
->tos
>> 2) |
1108 ULP_MODE_V(ULP_MODE_ISCSI
) |
1111 opt2
= RX_CHANNEL_V(0) |
1112 RSS_QUEUE_VALID_F
| RSS_QUEUE_V(csk
->rss_qid
);
1114 if (req
->tcpopt
.tstamp
)
1115 opt2
|= TSTAMPS_EN_F
;
1116 if (req
->tcpopt
.sack
)
1119 opt2
|= WND_SCALE_EN_F
;
1121 hlen
= ntohl(req
->hdr_len
);
1122 tcph
= (const void *)(req
+ 1) + ETH_HDR_LEN_G(hlen
) +
1125 if (tcph
->ece
&& tcph
->cwr
)
1126 opt2
|= CCTRL_ECN_V(1);
1128 opt2
|= RX_COALESCE_V(3);
1129 opt2
|= CONG_CNTRL_V(CONG_ALG_NEWRENO
);
1132 rpl5
->iss
= cpu_to_be32((prandom_u32() & ~7UL) - 1);
1134 opt2
|= T5_OPT_2_VALID_F
;
1136 rpl5
->opt0
= cpu_to_be64(opt0
);
1137 rpl5
->opt2
= cpu_to_be32(opt2
);
1138 set_wr_txq(skb
, CPL_PRIORITY_SETUP
, csk
->ctrlq_idx
);
1139 t4_set_arp_err_handler(skb
, NULL
, cxgbit_arp_failure_discard
);
1140 cxgbit_l2t_send(csk
->com
.cdev
, skb
, csk
->l2t
);
1144 cxgbit_pass_accept_req(struct cxgbit_device
*cdev
, struct sk_buff
*skb
)
1146 struct cxgbit_sock
*csk
= NULL
;
1147 struct cxgbit_np
*cnp
;
1148 struct cpl_pass_accept_req
*req
= cplhdr(skb
);
1149 unsigned int stid
= PASS_OPEN_TID_G(ntohl(req
->tos_stid
));
1150 struct tid_info
*t
= cdev
->lldi
.tids
;
1151 unsigned int tid
= GET_TID(req
);
1152 u16 peer_mss
= ntohs(req
->tcpopt
.mss
);
1153 unsigned short hdrs
;
1155 struct dst_entry
*dst
;
1156 __u8 local_ip
[16], peer_ip
[16];
1157 __be16 local_port
, peer_port
;
1161 pr_debug("%s: cdev = %p; stid = %u; tid = %u\n",
1162 __func__
, cdev
, stid
, tid
);
1164 cnp
= lookup_stid(t
, stid
);
1166 pr_err("%s connect request on invalid stid %d\n",
1171 if (cnp
->com
.state
!= CSK_STATE_LISTEN
) {
1172 pr_err("%s - listening parent not in CSK_STATE_LISTEN\n",
1177 csk
= lookup_tid(t
, tid
);
1179 pr_err("%s csk not null tid %u\n",
1184 cxgb_get_4tuple(req
, cdev
->lldi
.adapter_type
, &iptype
, local_ip
,
1185 peer_ip
, &local_port
, &peer_port
);
1187 /* Find output route */
1189 pr_debug("%s parent sock %p tid %u laddr %pI4 raddr %pI4 "
1190 "lport %d rport %d peer_mss %d\n"
1191 , __func__
, cnp
, tid
,
1192 local_ip
, peer_ip
, ntohs(local_port
),
1193 ntohs(peer_port
), peer_mss
);
1194 dst
= cxgb_find_route(&cdev
->lldi
, cxgbit_get_real_dev
,
1195 *(__be32
*)local_ip
,
1197 local_port
, peer_port
,
1198 PASS_OPEN_TOS_G(ntohl(req
->tos_stid
)));
1200 pr_debug("%s parent sock %p tid %u laddr %pI6 raddr %pI6 "
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_route6(&cdev
->lldi
, cxgbit_get_real_dev
,
1207 local_port
, peer_port
,
1208 PASS_OPEN_TOS_G(ntohl(req
->tos_stid
)),
1209 ((struct sockaddr_in6
*)
1210 &cnp
->com
.local_addr
)->sin6_scope_id
);
1213 pr_err("%s - failed to find dst entry!\n",
1218 csk
= kzalloc(sizeof(*csk
), GFP_ATOMIC
);
1224 ret
= cxgbit_offload_init(csk
, iptype
, peer_ip
, ntohs(local_port
),
1227 pr_err("%s - failed to allocate l2t entry!\n",
1234 kref_init(&csk
->kref
);
1235 init_completion(&csk
->com
.wr_wait
.completion
);
1237 INIT_LIST_HEAD(&csk
->accept_node
);
1239 hdrs
= (iptype
== 4 ? sizeof(struct iphdr
) : sizeof(struct ipv6hdr
)) +
1240 sizeof(struct tcphdr
) + (req
->tcpopt
.tstamp
? 12 : 0);
1241 if (peer_mss
&& csk
->mtu
> (peer_mss
+ hdrs
))
1242 csk
->mtu
= peer_mss
+ hdrs
;
1244 csk
->com
.state
= CSK_STATE_CONNECTING
;
1245 csk
->com
.cdev
= cdev
;
1247 csk
->tos
= PASS_OPEN_TOS_G(ntohl(req
->tos_stid
));
1250 csk
->wr_cred
= cdev
->lldi
.wr_cred
-
1251 DIV_ROUND_UP(sizeof(struct cpl_abort_req
), 16);
1252 csk
->wr_max_cred
= csk
->wr_cred
;
1253 csk
->wr_una_cred
= 0;
1256 struct sockaddr_in
*sin
= (struct sockaddr_in
*)
1257 &csk
->com
.local_addr
;
1258 sin
->sin_family
= AF_INET
;
1259 sin
->sin_port
= local_port
;
1260 sin
->sin_addr
.s_addr
= *(__be32
*)local_ip
;
1262 sin
= (struct sockaddr_in
*)&csk
->com
.remote_addr
;
1263 sin
->sin_family
= AF_INET
;
1264 sin
->sin_port
= peer_port
;
1265 sin
->sin_addr
.s_addr
= *(__be32
*)peer_ip
;
1267 struct sockaddr_in6
*sin6
= (struct sockaddr_in6
*)
1268 &csk
->com
.local_addr
;
1270 sin6
->sin6_family
= PF_INET6
;
1271 sin6
->sin6_port
= local_port
;
1272 memcpy(sin6
->sin6_addr
.s6_addr
, local_ip
, 16);
1273 cxgb4_clip_get(cdev
->lldi
.ports
[0],
1274 (const u32
*)&sin6
->sin6_addr
.s6_addr
,
1277 sin6
= (struct sockaddr_in6
*)&csk
->com
.remote_addr
;
1278 sin6
->sin6_family
= PF_INET6
;
1279 sin6
->sin6_port
= peer_port
;
1280 memcpy(sin6
->sin6_addr
.s6_addr
, peer_ip
, 16);
1283 skb_queue_head_init(&csk
->rxq
);
1284 skb_queue_head_init(&csk
->txq
);
1285 skb_queue_head_init(&csk
->ppodq
);
1286 skb_queue_head_init(&csk
->backlogq
);
1287 skb_queue_head_init(&csk
->skbq
);
1288 cxgbit_sock_reset_wr_list(csk
);
1289 spin_lock_init(&csk
->lock
);
1290 init_waitqueue_head(&csk
->waitq
);
1291 init_waitqueue_head(&csk
->ack_waitq
);
1292 csk
->lock_owner
= false;
1294 if (cxgbit_alloc_csk_skb(csk
)) {
1300 cxgbit_get_cdev(cdev
);
1302 spin_lock(&cdev
->cskq
.lock
);
1303 list_add_tail(&csk
->list
, &cdev
->cskq
.list
);
1304 spin_unlock(&cdev
->cskq
.lock
);
1306 cxgb4_insert_tid(t
, csk
, tid
);
1307 cxgbit_pass_accept_rpl(csk
, req
);
1311 cxgbit_release_tid(cdev
, tid
);
1317 cxgbit_tx_flowc_wr_credits(struct cxgbit_sock
*csk
, u32
*nparamsp
,
1320 u32 nparams
, flowclen16
, flowclen
;
1322 nparams
= FLOWC_WR_NPARAMS_MIN
;
1324 if (csk
->snd_wscale
)
1327 #ifdef CONFIG_CHELSIO_T4_DCB
1330 flowclen
= offsetof(struct fw_flowc_wr
, mnemval
[nparams
]);
1331 flowclen16
= DIV_ROUND_UP(flowclen
, 16);
1332 flowclen
= flowclen16
* 16;
1334 * Return the number of 16-byte credits used by the flowc request.
1335 * Pass back the nparams and actual flowc length if requested.
1338 *nparamsp
= nparams
;
1340 *flowclenp
= flowclen
;
1344 u32
cxgbit_send_tx_flowc_wr(struct cxgbit_sock
*csk
)
1346 struct cxgbit_device
*cdev
= csk
->com
.cdev
;
1347 struct fw_flowc_wr
*flowc
;
1348 u32 nparams
, flowclen16
, flowclen
;
1349 struct sk_buff
*skb
;
1352 #ifdef CONFIG_CHELSIO_T4_DCB
1353 u16 vlan
= ((struct l2t_entry
*)csk
->l2t
)->vlan
;
1356 flowclen16
= cxgbit_tx_flowc_wr_credits(csk
, &nparams
, &flowclen
);
1358 skb
= __skb_dequeue(&csk
->skbq
);
1359 flowc
= (struct fw_flowc_wr
*)__skb_put(skb
, flowclen
);
1360 memset(flowc
, 0, flowclen
);
1362 flowc
->op_to_nparams
= cpu_to_be32(FW_WR_OP_V(FW_FLOWC_WR
) |
1363 FW_FLOWC_WR_NPARAMS_V(nparams
));
1364 flowc
->flowid_len16
= cpu_to_be32(FW_WR_LEN16_V(flowclen16
) |
1365 FW_WR_FLOWID_V(csk
->tid
));
1366 flowc
->mnemval
[0].mnemonic
= FW_FLOWC_MNEM_PFNVFN
;
1367 flowc
->mnemval
[0].val
= cpu_to_be32(FW_PFVF_CMD_PFN_V
1368 (csk
->com
.cdev
->lldi
.pf
));
1369 flowc
->mnemval
[1].mnemonic
= FW_FLOWC_MNEM_CH
;
1370 flowc
->mnemval
[1].val
= cpu_to_be32(csk
->tx_chan
);
1371 flowc
->mnemval
[2].mnemonic
= FW_FLOWC_MNEM_PORT
;
1372 flowc
->mnemval
[2].val
= cpu_to_be32(csk
->tx_chan
);
1373 flowc
->mnemval
[3].mnemonic
= FW_FLOWC_MNEM_IQID
;
1374 flowc
->mnemval
[3].val
= cpu_to_be32(csk
->rss_qid
);
1375 flowc
->mnemval
[4].mnemonic
= FW_FLOWC_MNEM_SNDNXT
;
1376 flowc
->mnemval
[4].val
= cpu_to_be32(csk
->snd_nxt
);
1377 flowc
->mnemval
[5].mnemonic
= FW_FLOWC_MNEM_RCVNXT
;
1378 flowc
->mnemval
[5].val
= cpu_to_be32(csk
->rcv_nxt
);
1379 flowc
->mnemval
[6].mnemonic
= FW_FLOWC_MNEM_SNDBUF
;
1380 flowc
->mnemval
[6].val
= cpu_to_be32(csk
->snd_win
);
1381 flowc
->mnemval
[7].mnemonic
= FW_FLOWC_MNEM_MSS
;
1382 flowc
->mnemval
[7].val
= cpu_to_be32(csk
->emss
);
1384 flowc
->mnemval
[8].mnemonic
= FW_FLOWC_MNEM_TXDATAPLEN_MAX
;
1385 if (test_bit(CDEV_ISO_ENABLE
, &cdev
->flags
))
1386 flowc
->mnemval
[8].val
= cpu_to_be32(CXGBIT_MAX_ISO_PAYLOAD
);
1388 flowc
->mnemval
[8].val
= cpu_to_be32(16384);
1392 if (csk
->snd_wscale
) {
1393 flowc
->mnemval
[index
].mnemonic
= FW_FLOWC_MNEM_RCV_SCALE
;
1394 flowc
->mnemval
[index
].val
= cpu_to_be32(csk
->snd_wscale
);
1398 #ifdef CONFIG_CHELSIO_T4_DCB
1399 flowc
->mnemval
[index
].mnemonic
= FW_FLOWC_MNEM_DCBPRIO
;
1400 if (vlan
== VLAN_NONE
) {
1401 pr_warn("csk %u without VLAN Tag on DCB Link\n", csk
->tid
);
1402 flowc
->mnemval
[index
].val
= cpu_to_be32(0);
1404 flowc
->mnemval
[index
].val
= cpu_to_be32(
1405 (vlan
& VLAN_PRIO_MASK
) >> VLAN_PRIO_SHIFT
);
1408 pr_debug("%s: csk %p; tx_chan = %u; rss_qid = %u; snd_seq = %u;"
1409 " rcv_seq = %u; snd_win = %u; emss = %u\n",
1410 __func__
, csk
, csk
->tx_chan
, csk
->rss_qid
, csk
->snd_nxt
,
1411 csk
->rcv_nxt
, csk
->snd_win
, csk
->emss
);
1412 set_wr_txq(skb
, CPL_PRIORITY_DATA
, csk
->txq_idx
);
1413 cxgbit_ofld_send(csk
->com
.cdev
, skb
);
1417 int cxgbit_setup_conn_digest(struct cxgbit_sock
*csk
)
1419 struct sk_buff
*skb
;
1420 struct cpl_set_tcb_field
*req
;
1421 u8 hcrc
= csk
->submode
& CXGBIT_SUBMODE_HCRC
;
1422 u8 dcrc
= csk
->submode
& CXGBIT_SUBMODE_DCRC
;
1423 unsigned int len
= roundup(sizeof(*req
), 16);
1426 skb
= alloc_skb(len
, GFP_KERNEL
);
1430 /* set up ulp submode */
1431 req
= (struct cpl_set_tcb_field
*)__skb_put(skb
, len
);
1432 memset(req
, 0, len
);
1434 INIT_TP_WR(req
, csk
->tid
);
1435 OPCODE_TID(req
) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD
, csk
->tid
));
1436 req
->reply_ctrl
= htons(NO_REPLY_V(0) | QUEUENO_V(csk
->rss_qid
));
1437 req
->word_cookie
= htons(0);
1438 req
->mask
= cpu_to_be64(0x3 << 4);
1439 req
->val
= cpu_to_be64(((hcrc
? ULP_CRC_HEADER
: 0) |
1440 (dcrc
? ULP_CRC_DATA
: 0)) << 4);
1441 set_wr_txq(skb
, CPL_PRIORITY_CONTROL
, csk
->ctrlq_idx
);
1443 cxgbit_get_csk(csk
);
1444 cxgbit_init_wr_wait(&csk
->com
.wr_wait
);
1446 cxgbit_ofld_send(csk
->com
.cdev
, skb
);
1448 ret
= cxgbit_wait_for_reply(csk
->com
.cdev
,
1450 csk
->tid
, 5, __func__
);
1457 int cxgbit_setup_conn_pgidx(struct cxgbit_sock
*csk
, u32 pg_idx
)
1459 struct sk_buff
*skb
;
1460 struct cpl_set_tcb_field
*req
;
1461 unsigned int len
= roundup(sizeof(*req
), 16);
1464 skb
= alloc_skb(len
, GFP_KERNEL
);
1468 req
= (struct cpl_set_tcb_field
*)__skb_put(skb
, len
);
1469 memset(req
, 0, len
);
1471 INIT_TP_WR(req
, csk
->tid
);
1472 OPCODE_TID(req
) = htonl(MK_OPCODE_TID(CPL_SET_TCB_FIELD
, csk
->tid
));
1473 req
->reply_ctrl
= htons(NO_REPLY_V(0) | QUEUENO_V(csk
->rss_qid
));
1474 req
->word_cookie
= htons(0);
1475 req
->mask
= cpu_to_be64(0x3 << 8);
1476 req
->val
= cpu_to_be64(pg_idx
<< 8);
1477 set_wr_txq(skb
, CPL_PRIORITY_CONTROL
, csk
->ctrlq_idx
);
1479 cxgbit_get_csk(csk
);
1480 cxgbit_init_wr_wait(&csk
->com
.wr_wait
);
1482 cxgbit_ofld_send(csk
->com
.cdev
, skb
);
1484 ret
= cxgbit_wait_for_reply(csk
->com
.cdev
,
1486 csk
->tid
, 5, __func__
);
1494 cxgbit_pass_open_rpl(struct cxgbit_device
*cdev
, struct sk_buff
*skb
)
1496 struct cpl_pass_open_rpl
*rpl
= cplhdr(skb
);
1497 struct tid_info
*t
= cdev
->lldi
.tids
;
1498 unsigned int stid
= GET_TID(rpl
);
1499 struct cxgbit_np
*cnp
= lookup_stid(t
, stid
);
1501 pr_debug("%s: cnp = %p; stid = %u; status = %d\n",
1502 __func__
, cnp
, stid
, rpl
->status
);
1505 pr_info("%s stid %d lookup failure\n", __func__
, stid
);
1509 cxgbit_wake_up(&cnp
->com
.wr_wait
, __func__
, rpl
->status
);
1510 cxgbit_put_cnp(cnp
);
1514 cxgbit_close_listsrv_rpl(struct cxgbit_device
*cdev
, struct sk_buff
*skb
)
1516 struct cpl_close_listsvr_rpl
*rpl
= cplhdr(skb
);
1517 struct tid_info
*t
= cdev
->lldi
.tids
;
1518 unsigned int stid
= GET_TID(rpl
);
1519 struct cxgbit_np
*cnp
= lookup_stid(t
, stid
);
1521 pr_debug("%s: cnp = %p; stid = %u; status = %d\n",
1522 __func__
, cnp
, stid
, rpl
->status
);
1525 pr_info("%s stid %d lookup failure\n", __func__
, stid
);
1529 cxgbit_wake_up(&cnp
->com
.wr_wait
, __func__
, rpl
->status
);
1530 cxgbit_put_cnp(cnp
);
1534 cxgbit_pass_establish(struct cxgbit_device
*cdev
, struct sk_buff
*skb
)
1536 struct cpl_pass_establish
*req
= cplhdr(skb
);
1537 struct tid_info
*t
= cdev
->lldi
.tids
;
1538 unsigned int tid
= GET_TID(req
);
1539 struct cxgbit_sock
*csk
;
1540 struct cxgbit_np
*cnp
;
1541 u16 tcp_opt
= be16_to_cpu(req
->tcp_opt
);
1542 u32 snd_isn
= be32_to_cpu(req
->snd_isn
);
1543 u32 rcv_isn
= be32_to_cpu(req
->rcv_isn
);
1545 csk
= lookup_tid(t
, tid
);
1546 if (unlikely(!csk
)) {
1547 pr_err("can't find connection for tid %u.\n", tid
);
1552 pr_debug("%s: csk %p; tid %u; cnp %p\n",
1553 __func__
, csk
, tid
, cnp
);
1555 csk
->write_seq
= snd_isn
;
1556 csk
->snd_una
= snd_isn
;
1557 csk
->snd_nxt
= snd_isn
;
1559 csk
->rcv_nxt
= rcv_isn
;
1561 if (csk
->rcv_win
> (RCV_BUFSIZ_M
<< 10))
1562 csk
->rx_credits
= (csk
->rcv_win
- (RCV_BUFSIZ_M
<< 10));
1564 csk
->snd_wscale
= TCPOPT_SND_WSCALE_G(tcp_opt
);
1565 cxgbit_set_emss(csk
, tcp_opt
);
1566 dst_confirm(csk
->dst
);
1567 csk
->com
.state
= CSK_STATE_ESTABLISHED
;
1568 spin_lock_bh(&cnp
->np_accept_lock
);
1569 list_add_tail(&csk
->accept_node
, &cnp
->np_accept_list
);
1570 spin_unlock_bh(&cnp
->np_accept_lock
);
1571 complete(&cnp
->accept_comp
);
1576 static void cxgbit_queue_rx_skb(struct cxgbit_sock
*csk
, struct sk_buff
*skb
)
1578 cxgbit_skcb_flags(skb
) = 0;
1579 spin_lock_bh(&csk
->rxq
.lock
);
1580 __skb_queue_tail(&csk
->rxq
, skb
);
1581 spin_unlock_bh(&csk
->rxq
.lock
);
1582 wake_up(&csk
->waitq
);
1585 static void cxgbit_peer_close(struct cxgbit_sock
*csk
, struct sk_buff
*skb
)
1587 pr_debug("%s: csk %p; tid %u; state %d\n",
1588 __func__
, csk
, csk
->tid
, csk
->com
.state
);
1590 switch (csk
->com
.state
) {
1591 case CSK_STATE_ESTABLISHED
:
1592 csk
->com
.state
= CSK_STATE_CLOSING
;
1593 cxgbit_queue_rx_skb(csk
, skb
);
1595 case CSK_STATE_CLOSING
:
1596 /* simultaneous close */
1597 csk
->com
.state
= CSK_STATE_MORIBUND
;
1599 case CSK_STATE_MORIBUND
:
1600 csk
->com
.state
= CSK_STATE_DEAD
;
1601 cxgbit_put_csk(csk
);
1603 case CSK_STATE_ABORTING
:
1606 pr_info("%s: cpl_peer_close in bad state %d\n",
1607 __func__
, csk
->com
.state
);
1613 static void cxgbit_close_con_rpl(struct cxgbit_sock
*csk
, struct sk_buff
*skb
)
1615 pr_debug("%s: csk %p; tid %u; state %d\n",
1616 __func__
, csk
, csk
->tid
, csk
->com
.state
);
1618 switch (csk
->com
.state
) {
1619 case CSK_STATE_CLOSING
:
1620 csk
->com
.state
= CSK_STATE_MORIBUND
;
1622 case CSK_STATE_MORIBUND
:
1623 csk
->com
.state
= CSK_STATE_DEAD
;
1624 cxgbit_put_csk(csk
);
1626 case CSK_STATE_ABORTING
:
1627 case CSK_STATE_DEAD
:
1630 pr_info("%s: cpl_close_con_rpl in bad state %d\n",
1631 __func__
, csk
->com
.state
);
1637 static void cxgbit_abort_req_rss(struct cxgbit_sock
*csk
, struct sk_buff
*skb
)
1639 struct cpl_abort_req_rss
*hdr
= cplhdr(skb
);
1640 unsigned int tid
= GET_TID(hdr
);
1641 struct sk_buff
*rpl_skb
;
1642 bool release
= false;
1643 bool wakeup_thread
= false;
1644 u32 len
= roundup(sizeof(struct cpl_abort_rpl
), 16);
1646 pr_debug("%s: csk %p; tid %u; state %d\n",
1647 __func__
, csk
, tid
, csk
->com
.state
);
1649 if (cxgb_is_neg_adv(hdr
->status
)) {
1650 pr_err("%s: got neg advise %d on tid %u\n",
1651 __func__
, hdr
->status
, tid
);
1655 switch (csk
->com
.state
) {
1656 case CSK_STATE_CONNECTING
:
1657 case CSK_STATE_MORIBUND
:
1658 csk
->com
.state
= CSK_STATE_DEAD
;
1661 case CSK_STATE_ESTABLISHED
:
1662 csk
->com
.state
= CSK_STATE_DEAD
;
1663 wakeup_thread
= true;
1665 case CSK_STATE_CLOSING
:
1666 csk
->com
.state
= CSK_STATE_DEAD
;
1670 case CSK_STATE_ABORTING
:
1673 pr_info("%s: cpl_abort_req_rss in bad state %d\n",
1674 __func__
, csk
->com
.state
);
1675 csk
->com
.state
= CSK_STATE_DEAD
;
1678 __skb_queue_purge(&csk
->txq
);
1680 if (!test_and_set_bit(CSK_TX_DATA_SENT
, &csk
->com
.flags
))
1681 cxgbit_send_tx_flowc_wr(csk
);
1683 rpl_skb
= __skb_dequeue(&csk
->skbq
);
1685 cxgb_mk_abort_rpl(rpl_skb
, len
, csk
->tid
, csk
->txq_idx
);
1686 cxgbit_ofld_send(csk
->com
.cdev
, rpl_skb
);
1688 if (wakeup_thread
) {
1689 cxgbit_queue_rx_skb(csk
, skb
);
1694 cxgbit_put_csk(csk
);
1699 static void cxgbit_abort_rpl_rss(struct cxgbit_sock
*csk
, struct sk_buff
*skb
)
1701 pr_debug("%s: csk %p; tid %u; state %d\n",
1702 __func__
, csk
, csk
->tid
, csk
->com
.state
);
1704 switch (csk
->com
.state
) {
1705 case CSK_STATE_ABORTING
:
1706 csk
->com
.state
= CSK_STATE_DEAD
;
1707 cxgbit_put_csk(csk
);
1710 pr_info("%s: cpl_abort_rpl_rss in state %d\n",
1711 __func__
, csk
->com
.state
);
1717 static bool cxgbit_credit_err(const struct cxgbit_sock
*csk
)
1719 const struct sk_buff
*skb
= csk
->wr_pending_head
;
1722 if (unlikely(csk
->wr_cred
> csk
->wr_max_cred
)) {
1723 pr_err("csk 0x%p, tid %u, credit %u > %u\n",
1724 csk
, csk
->tid
, csk
->wr_cred
, csk
->wr_max_cred
);
1729 credit
+= skb
->csum
;
1730 skb
= cxgbit_skcb_tx_wr_next(skb
);
1733 if (unlikely((csk
->wr_cred
+ credit
) != csk
->wr_max_cred
)) {
1734 pr_err("csk 0x%p, tid %u, credit %u + %u != %u.\n",
1735 csk
, csk
->tid
, csk
->wr_cred
,
1736 credit
, csk
->wr_max_cred
);
1744 static void cxgbit_fw4_ack(struct cxgbit_sock
*csk
, struct sk_buff
*skb
)
1746 struct cpl_fw4_ack
*rpl
= (struct cpl_fw4_ack
*)cplhdr(skb
);
1747 u32 credits
= rpl
->credits
;
1748 u32 snd_una
= ntohl(rpl
->snd_una
);
1750 csk
->wr_cred
+= credits
;
1751 if (csk
->wr_una_cred
> (csk
->wr_max_cred
- csk
->wr_cred
))
1752 csk
->wr_una_cred
= csk
->wr_max_cred
- csk
->wr_cred
;
1755 struct sk_buff
*p
= cxgbit_sock_peek_wr(csk
);
1758 pr_err("csk 0x%p,%u, cr %u,%u+%u, empty.\n",
1759 csk
, csk
->tid
, credits
,
1760 csk
->wr_cred
, csk
->wr_una_cred
);
1764 if (unlikely(credits
< p
->csum
)) {
1765 pr_warn("csk 0x%p,%u, cr %u,%u+%u, < %u.\n",
1767 credits
, csk
->wr_cred
, csk
->wr_una_cred
,
1773 cxgbit_sock_dequeue_wr(csk
);
1778 if (unlikely(cxgbit_credit_err(csk
))) {
1779 cxgbit_queue_rx_skb(csk
, skb
);
1783 if (rpl
->seq_vld
& CPL_FW4_ACK_FLAGS_SEQVAL
) {
1784 if (unlikely(before(snd_una
, csk
->snd_una
))) {
1785 pr_warn("csk 0x%p,%u, snd_una %u/%u.",
1786 csk
, csk
->tid
, snd_una
,
1791 if (csk
->snd_una
!= snd_una
) {
1792 csk
->snd_una
= snd_una
;
1793 dst_confirm(csk
->dst
);
1794 wake_up(&csk
->ack_waitq
);
1798 if (skb_queue_len(&csk
->txq
))
1799 cxgbit_push_tx_frames(csk
);
1805 static void cxgbit_set_tcb_rpl(struct cxgbit_device
*cdev
, struct sk_buff
*skb
)
1807 struct cxgbit_sock
*csk
;
1808 struct cpl_set_tcb_rpl
*rpl
= (struct cpl_set_tcb_rpl
*)skb
->data
;
1809 unsigned int tid
= GET_TID(rpl
);
1810 struct cxgb4_lld_info
*lldi
= &cdev
->lldi
;
1811 struct tid_info
*t
= lldi
->tids
;
1813 csk
= lookup_tid(t
, tid
);
1815 pr_err("can't find connection for tid %u.\n", tid
);
1817 cxgbit_wake_up(&csk
->com
.wr_wait
, __func__
, rpl
->status
);
1819 cxgbit_put_csk(csk
);
1822 static void cxgbit_rx_data(struct cxgbit_device
*cdev
, struct sk_buff
*skb
)
1824 struct cxgbit_sock
*csk
;
1825 struct cpl_rx_data
*cpl
= cplhdr(skb
);
1826 unsigned int tid
= GET_TID(cpl
);
1827 struct cxgb4_lld_info
*lldi
= &cdev
->lldi
;
1828 struct tid_info
*t
= lldi
->tids
;
1830 csk
= lookup_tid(t
, tid
);
1831 if (unlikely(!csk
)) {
1832 pr_err("can't find conn. for tid %u.\n", tid
);
1836 cxgbit_queue_rx_skb(csk
, skb
);
1843 __cxgbit_process_rx_cpl(struct cxgbit_sock
*csk
, struct sk_buff
*skb
)
1845 spin_lock(&csk
->lock
);
1846 if (csk
->lock_owner
) {
1847 __skb_queue_tail(&csk
->backlogq
, skb
);
1848 spin_unlock(&csk
->lock
);
1852 cxgbit_skcb_rx_backlog_fn(skb
)(csk
, skb
);
1853 spin_unlock(&csk
->lock
);
1856 static void cxgbit_process_rx_cpl(struct cxgbit_sock
*csk
, struct sk_buff
*skb
)
1858 cxgbit_get_csk(csk
);
1859 __cxgbit_process_rx_cpl(csk
, skb
);
1860 cxgbit_put_csk(csk
);
1863 static void cxgbit_rx_cpl(struct cxgbit_device
*cdev
, struct sk_buff
*skb
)
1865 struct cxgbit_sock
*csk
;
1866 struct cpl_tx_data
*cpl
= cplhdr(skb
);
1867 struct cxgb4_lld_info
*lldi
= &cdev
->lldi
;
1868 struct tid_info
*t
= lldi
->tids
;
1869 unsigned int tid
= GET_TID(cpl
);
1870 u8 opcode
= cxgbit_skcb_rx_opcode(skb
);
1875 cxgbit_skcb_rx_backlog_fn(skb
) = cxgbit_fw4_ack
;
1878 case CPL_PEER_CLOSE
:
1879 cxgbit_skcb_rx_backlog_fn(skb
) = cxgbit_peer_close
;
1881 case CPL_CLOSE_CON_RPL
:
1882 cxgbit_skcb_rx_backlog_fn(skb
) = cxgbit_close_con_rpl
;
1884 case CPL_ABORT_REQ_RSS
:
1885 cxgbit_skcb_rx_backlog_fn(skb
) = cxgbit_abort_req_rss
;
1887 case CPL_ABORT_RPL_RSS
:
1888 cxgbit_skcb_rx_backlog_fn(skb
) = cxgbit_abort_rpl_rss
;
1894 csk
= lookup_tid(t
, tid
);
1895 if (unlikely(!csk
)) {
1896 pr_err("can't find conn. for tid %u.\n", tid
);
1901 cxgbit_process_rx_cpl(csk
, skb
);
1903 __cxgbit_process_rx_cpl(csk
, skb
);
1910 cxgbit_cplhandler_func cxgbit_cplhandlers
[NUM_CPL_CMDS
] = {
1911 [CPL_PASS_OPEN_RPL
] = cxgbit_pass_open_rpl
,
1912 [CPL_CLOSE_LISTSRV_RPL
] = cxgbit_close_listsrv_rpl
,
1913 [CPL_PASS_ACCEPT_REQ
] = cxgbit_pass_accept_req
,
1914 [CPL_PASS_ESTABLISH
] = cxgbit_pass_establish
,
1915 [CPL_SET_TCB_RPL
] = cxgbit_set_tcb_rpl
,
1916 [CPL_RX_DATA
] = cxgbit_rx_data
,
1917 [CPL_FW4_ACK
] = cxgbit_rx_cpl
,
1918 [CPL_PEER_CLOSE
] = cxgbit_rx_cpl
,
1919 [CPL_CLOSE_CON_RPL
] = cxgbit_rx_cpl
,
1920 [CPL_ABORT_REQ_RSS
] = cxgbit_rx_cpl
,
1921 [CPL_ABORT_RPL_RSS
] = cxgbit_rx_cpl
,