1 /* cnic.c: Broadcom CNIC core network driver.
3 * Copyright (c) 2006-2009 Broadcom Corporation
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation.
9 * Original skeleton written by: John(Zongxi) Chen (zongxi@broadcom.com)
10 * Modified and maintained by: Michael Chan <mchan@broadcom.com>
13 #include <linux/module.h>
15 #include <linux/kernel.h>
16 #include <linux/errno.h>
17 #include <linux/list.h>
18 #include <linux/slab.h>
19 #include <linux/pci.h>
20 #include <linux/init.h>
21 #include <linux/netdevice.h>
22 #include <linux/uio_driver.h>
24 #include <linux/dma-mapping.h>
25 #include <linux/delay.h>
26 #include <linux/ethtool.h>
27 #include <linux/if_vlan.h>
28 #if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)
33 #include <net/route.h>
35 #include <net/ip6_route.h>
36 #include <scsi/iscsi_if.h>
41 #include "cnic_defs.h"
43 #define DRV_MODULE_NAME "cnic"
44 #define PFX DRV_MODULE_NAME ": "
46 static char version
[] __devinitdata
=
47 "Broadcom NetXtreme II CNIC Driver " DRV_MODULE_NAME
" v" CNIC_MODULE_VERSION
" (" CNIC_MODULE_RELDATE
")\n";
49 MODULE_AUTHOR("Michael Chan <mchan@broadcom.com> and John(Zongxi) "
50 "Chen (zongxi@broadcom.com");
51 MODULE_DESCRIPTION("Broadcom NetXtreme II CNIC Driver");
52 MODULE_LICENSE("GPL");
53 MODULE_VERSION(CNIC_MODULE_VERSION
);
55 static LIST_HEAD(cnic_dev_list
);
56 static DEFINE_RWLOCK(cnic_dev_lock
);
57 static DEFINE_MUTEX(cnic_lock
);
59 static struct cnic_ulp_ops
*cnic_ulp_tbl
[MAX_CNIC_ULP_TYPE
];
61 static int cnic_service_bnx2(void *, void *);
62 static int cnic_ctl(void *, struct cnic_ctl_info
*);
64 static struct cnic_ops cnic_bnx2_ops
= {
65 .cnic_owner
= THIS_MODULE
,
66 .cnic_handler
= cnic_service_bnx2
,
70 static void cnic_shutdown_bnx2_rx_ring(struct cnic_dev
*);
71 static void cnic_init_bnx2_tx_ring(struct cnic_dev
*);
72 static void cnic_init_bnx2_rx_ring(struct cnic_dev
*);
73 static int cnic_cm_set_pg(struct cnic_sock
*);
75 static int cnic_uio_open(struct uio_info
*uinfo
, struct inode
*inode
)
77 struct cnic_dev
*dev
= uinfo
->priv
;
78 struct cnic_local
*cp
= dev
->cnic_priv
;
80 if (!capable(CAP_NET_ADMIN
))
83 if (cp
->uio_dev
!= -1)
86 cp
->uio_dev
= iminor(inode
);
88 cnic_shutdown_bnx2_rx_ring(dev
);
90 cnic_init_bnx2_tx_ring(dev
);
91 cnic_init_bnx2_rx_ring(dev
);
96 static int cnic_uio_close(struct uio_info
*uinfo
, struct inode
*inode
)
98 struct cnic_dev
*dev
= uinfo
->priv
;
99 struct cnic_local
*cp
= dev
->cnic_priv
;
105 static inline void cnic_hold(struct cnic_dev
*dev
)
107 atomic_inc(&dev
->ref_count
);
110 static inline void cnic_put(struct cnic_dev
*dev
)
112 atomic_dec(&dev
->ref_count
);
115 static inline void csk_hold(struct cnic_sock
*csk
)
117 atomic_inc(&csk
->ref_count
);
120 static inline void csk_put(struct cnic_sock
*csk
)
122 atomic_dec(&csk
->ref_count
);
125 static struct cnic_dev
*cnic_from_netdev(struct net_device
*netdev
)
127 struct cnic_dev
*cdev
;
129 read_lock(&cnic_dev_lock
);
130 list_for_each_entry(cdev
, &cnic_dev_list
, list
) {
131 if (netdev
== cdev
->netdev
) {
133 read_unlock(&cnic_dev_lock
);
137 read_unlock(&cnic_dev_lock
);
141 static void cnic_ctx_wr(struct cnic_dev
*dev
, u32 cid_addr
, u32 off
, u32 val
)
143 struct cnic_local
*cp
= dev
->cnic_priv
;
144 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
145 struct drv_ctl_info info
;
146 struct drv_ctl_io
*io
= &info
.data
.io
;
148 info
.cmd
= DRV_CTL_CTX_WR_CMD
;
149 io
->cid_addr
= cid_addr
;
152 ethdev
->drv_ctl(dev
->netdev
, &info
);
155 static void cnic_reg_wr_ind(struct cnic_dev
*dev
, u32 off
, u32 val
)
157 struct cnic_local
*cp
= dev
->cnic_priv
;
158 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
159 struct drv_ctl_info info
;
160 struct drv_ctl_io
*io
= &info
.data
.io
;
162 info
.cmd
= DRV_CTL_IO_WR_CMD
;
165 ethdev
->drv_ctl(dev
->netdev
, &info
);
168 static u32
cnic_reg_rd_ind(struct cnic_dev
*dev
, u32 off
)
170 struct cnic_local
*cp
= dev
->cnic_priv
;
171 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
172 struct drv_ctl_info info
;
173 struct drv_ctl_io
*io
= &info
.data
.io
;
175 info
.cmd
= DRV_CTL_IO_RD_CMD
;
177 ethdev
->drv_ctl(dev
->netdev
, &info
);
181 static int cnic_in_use(struct cnic_sock
*csk
)
183 return test_bit(SK_F_INUSE
, &csk
->flags
);
186 static void cnic_kwq_completion(struct cnic_dev
*dev
, u32 count
)
188 struct cnic_local
*cp
= dev
->cnic_priv
;
189 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
190 struct drv_ctl_info info
;
192 info
.cmd
= DRV_CTL_COMPLETION_CMD
;
193 info
.data
.comp
.comp_count
= count
;
194 ethdev
->drv_ctl(dev
->netdev
, &info
);
197 static int cnic_send_nlmsg(struct cnic_local
*cp
, u32 type
,
198 struct cnic_sock
*csk
)
200 struct iscsi_path path_req
;
203 u32 msg_type
= ISCSI_KEVENT_IF_DOWN
;
204 struct cnic_ulp_ops
*ulp_ops
;
206 if (cp
->uio_dev
== -1)
210 len
= sizeof(path_req
);
211 buf
= (char *) &path_req
;
212 memset(&path_req
, 0, len
);
214 msg_type
= ISCSI_KEVENT_PATH_REQ
;
215 path_req
.handle
= (u64
) csk
->l5_cid
;
216 if (test_bit(SK_F_IPV6
, &csk
->flags
)) {
217 memcpy(&path_req
.dst
.v6_addr
, &csk
->dst_ip
[0],
218 sizeof(struct in6_addr
));
219 path_req
.ip_addr_len
= 16;
221 memcpy(&path_req
.dst
.v4_addr
, &csk
->dst_ip
[0],
222 sizeof(struct in_addr
));
223 path_req
.ip_addr_len
= 4;
225 path_req
.vlan_id
= csk
->vlan_id
;
226 path_req
.pmtu
= csk
->mtu
;
230 ulp_ops
= rcu_dereference(cnic_ulp_tbl
[CNIC_ULP_ISCSI
]);
232 ulp_ops
->iscsi_nl_send_msg(cp
->dev
, msg_type
, buf
, len
);
237 static int cnic_iscsi_nl_msg_recv(struct cnic_dev
*dev
, u32 msg_type
,
243 case ISCSI_UEVENT_PATH_UPDATE
: {
244 struct cnic_local
*cp
;
246 struct cnic_sock
*csk
;
247 struct iscsi_path
*path_resp
;
249 if (len
< sizeof(*path_resp
))
252 path_resp
= (struct iscsi_path
*) buf
;
254 l5_cid
= (u32
) path_resp
->handle
;
255 if (l5_cid
>= MAX_CM_SK_TBL_SZ
)
258 csk
= &cp
->csk_tbl
[l5_cid
];
260 if (cnic_in_use(csk
)) {
261 memcpy(csk
->ha
, path_resp
->mac_addr
, 6);
262 if (test_bit(SK_F_IPV6
, &csk
->flags
))
263 memcpy(&csk
->src_ip
[0], &path_resp
->src
.v6_addr
,
264 sizeof(struct in6_addr
));
266 memcpy(&csk
->src_ip
[0], &path_resp
->src
.v4_addr
,
267 sizeof(struct in_addr
));
268 if (is_valid_ether_addr(csk
->ha
))
279 static int cnic_offld_prep(struct cnic_sock
*csk
)
281 if (test_and_set_bit(SK_F_OFFLD_SCHED
, &csk
->flags
))
284 if (!test_bit(SK_F_CONNECT_START
, &csk
->flags
)) {
285 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
292 static int cnic_close_prep(struct cnic_sock
*csk
)
294 clear_bit(SK_F_CONNECT_START
, &csk
->flags
);
295 smp_mb__after_clear_bit();
297 if (test_and_clear_bit(SK_F_OFFLD_COMPLETE
, &csk
->flags
)) {
298 while (test_and_set_bit(SK_F_OFFLD_SCHED
, &csk
->flags
))
306 static int cnic_abort_prep(struct cnic_sock
*csk
)
308 clear_bit(SK_F_CONNECT_START
, &csk
->flags
);
309 smp_mb__after_clear_bit();
311 while (test_and_set_bit(SK_F_OFFLD_SCHED
, &csk
->flags
))
314 if (test_and_clear_bit(SK_F_OFFLD_COMPLETE
, &csk
->flags
)) {
315 csk
->state
= L4_KCQE_OPCODE_VALUE_RESET_COMP
;
322 static void cnic_uio_stop(void)
324 struct cnic_dev
*dev
;
326 read_lock(&cnic_dev_lock
);
327 list_for_each_entry(dev
, &cnic_dev_list
, list
) {
328 struct cnic_local
*cp
= dev
->cnic_priv
;
331 cnic_send_nlmsg(cp
, ISCSI_KEVENT_IF_DOWN
, NULL
);
333 read_unlock(&cnic_dev_lock
);
336 int cnic_register_driver(int ulp_type
, struct cnic_ulp_ops
*ulp_ops
)
338 struct cnic_dev
*dev
;
340 if (ulp_type
>= MAX_CNIC_ULP_TYPE
) {
341 printk(KERN_ERR PFX
"cnic_register_driver: Bad type %d\n",
345 mutex_lock(&cnic_lock
);
346 if (cnic_ulp_tbl
[ulp_type
]) {
347 printk(KERN_ERR PFX
"cnic_register_driver: Type %d has already "
348 "been registered\n", ulp_type
);
349 mutex_unlock(&cnic_lock
);
353 read_lock(&cnic_dev_lock
);
354 list_for_each_entry(dev
, &cnic_dev_list
, list
) {
355 struct cnic_local
*cp
= dev
->cnic_priv
;
357 clear_bit(ULP_F_INIT
, &cp
->ulp_flags
[ulp_type
]);
359 read_unlock(&cnic_dev_lock
);
361 rcu_assign_pointer(cnic_ulp_tbl
[ulp_type
], ulp_ops
);
362 mutex_unlock(&cnic_lock
);
364 /* Prevent race conditions with netdev_event */
366 read_lock(&cnic_dev_lock
);
367 list_for_each_entry(dev
, &cnic_dev_list
, list
) {
368 struct cnic_local
*cp
= dev
->cnic_priv
;
370 if (!test_and_set_bit(ULP_F_INIT
, &cp
->ulp_flags
[ulp_type
]))
371 ulp_ops
->cnic_init(dev
);
373 read_unlock(&cnic_dev_lock
);
379 int cnic_unregister_driver(int ulp_type
)
381 struct cnic_dev
*dev
;
383 if (ulp_type
>= MAX_CNIC_ULP_TYPE
) {
384 printk(KERN_ERR PFX
"cnic_unregister_driver: Bad type %d\n",
388 mutex_lock(&cnic_lock
);
389 if (!cnic_ulp_tbl
[ulp_type
]) {
390 printk(KERN_ERR PFX
"cnic_unregister_driver: Type %d has not "
391 "been registered\n", ulp_type
);
394 read_lock(&cnic_dev_lock
);
395 list_for_each_entry(dev
, &cnic_dev_list
, list
) {
396 struct cnic_local
*cp
= dev
->cnic_priv
;
398 if (rcu_dereference(cp
->ulp_ops
[ulp_type
])) {
399 printk(KERN_ERR PFX
"cnic_unregister_driver: Type %d "
400 "still has devices registered\n", ulp_type
);
401 read_unlock(&cnic_dev_lock
);
405 read_unlock(&cnic_dev_lock
);
407 if (ulp_type
== CNIC_ULP_ISCSI
)
410 rcu_assign_pointer(cnic_ulp_tbl
[ulp_type
], NULL
);
412 mutex_unlock(&cnic_lock
);
417 mutex_unlock(&cnic_lock
);
421 static int cnic_start_hw(struct cnic_dev
*);
422 static void cnic_stop_hw(struct cnic_dev
*);
424 static int cnic_register_device(struct cnic_dev
*dev
, int ulp_type
,
427 struct cnic_local
*cp
= dev
->cnic_priv
;
428 struct cnic_ulp_ops
*ulp_ops
;
430 if (ulp_type
>= MAX_CNIC_ULP_TYPE
) {
431 printk(KERN_ERR PFX
"cnic_register_device: Bad type %d\n",
435 mutex_lock(&cnic_lock
);
436 if (cnic_ulp_tbl
[ulp_type
] == NULL
) {
437 printk(KERN_ERR PFX
"cnic_register_device: Driver with type %d "
438 "has not been registered\n", ulp_type
);
439 mutex_unlock(&cnic_lock
);
442 if (rcu_dereference(cp
->ulp_ops
[ulp_type
])) {
443 printk(KERN_ERR PFX
"cnic_register_device: Type %d has already "
444 "been registered to this device\n", ulp_type
);
445 mutex_unlock(&cnic_lock
);
449 clear_bit(ULP_F_START
, &cp
->ulp_flags
[ulp_type
]);
450 cp
->ulp_handle
[ulp_type
] = ulp_ctx
;
451 ulp_ops
= cnic_ulp_tbl
[ulp_type
];
452 rcu_assign_pointer(cp
->ulp_ops
[ulp_type
], ulp_ops
);
455 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
))
456 if (!test_and_set_bit(ULP_F_START
, &cp
->ulp_flags
[ulp_type
]))
457 ulp_ops
->cnic_start(cp
->ulp_handle
[ulp_type
]);
459 mutex_unlock(&cnic_lock
);
464 EXPORT_SYMBOL(cnic_register_driver
);
466 static int cnic_unregister_device(struct cnic_dev
*dev
, int ulp_type
)
468 struct cnic_local
*cp
= dev
->cnic_priv
;
470 if (ulp_type
>= MAX_CNIC_ULP_TYPE
) {
471 printk(KERN_ERR PFX
"cnic_unregister_device: Bad type %d\n",
475 mutex_lock(&cnic_lock
);
476 if (rcu_dereference(cp
->ulp_ops
[ulp_type
])) {
477 rcu_assign_pointer(cp
->ulp_ops
[ulp_type
], NULL
);
480 printk(KERN_ERR PFX
"cnic_unregister_device: device not "
481 "registered to this ulp type %d\n", ulp_type
);
482 mutex_unlock(&cnic_lock
);
485 mutex_unlock(&cnic_lock
);
491 EXPORT_SYMBOL(cnic_unregister_driver
);
493 static int cnic_init_id_tbl(struct cnic_id_tbl
*id_tbl
, u32 size
, u32 start_id
)
495 id_tbl
->start
= start_id
;
498 spin_lock_init(&id_tbl
->lock
);
499 id_tbl
->table
= kzalloc(DIV_ROUND_UP(size
, 32) * 4, GFP_KERNEL
);
506 static void cnic_free_id_tbl(struct cnic_id_tbl
*id_tbl
)
508 kfree(id_tbl
->table
);
509 id_tbl
->table
= NULL
;
512 static int cnic_alloc_id(struct cnic_id_tbl
*id_tbl
, u32 id
)
517 if (id
>= id_tbl
->max
)
520 spin_lock(&id_tbl
->lock
);
521 if (!test_bit(id
, id_tbl
->table
)) {
522 set_bit(id
, id_tbl
->table
);
525 spin_unlock(&id_tbl
->lock
);
529 /* Returns -1 if not successful */
530 static u32
cnic_alloc_new_id(struct cnic_id_tbl
*id_tbl
)
534 spin_lock(&id_tbl
->lock
);
535 id
= find_next_zero_bit(id_tbl
->table
, id_tbl
->max
, id_tbl
->next
);
536 if (id
>= id_tbl
->max
) {
538 if (id_tbl
->next
!= 0) {
539 id
= find_first_zero_bit(id_tbl
->table
, id_tbl
->next
);
540 if (id
>= id_tbl
->next
)
545 if (id
< id_tbl
->max
) {
546 set_bit(id
, id_tbl
->table
);
547 id_tbl
->next
= (id
+ 1) & (id_tbl
->max
- 1);
551 spin_unlock(&id_tbl
->lock
);
556 static void cnic_free_id(struct cnic_id_tbl
*id_tbl
, u32 id
)
562 if (id
>= id_tbl
->max
)
565 clear_bit(id
, id_tbl
->table
);
568 static void cnic_free_dma(struct cnic_dev
*dev
, struct cnic_dma
*dma
)
575 for (i
= 0; i
< dma
->num_pages
; i
++) {
576 if (dma
->pg_arr
[i
]) {
577 pci_free_consistent(dev
->pcidev
, BCM_PAGE_SIZE
,
578 dma
->pg_arr
[i
], dma
->pg_map_arr
[i
]);
579 dma
->pg_arr
[i
] = NULL
;
583 pci_free_consistent(dev
->pcidev
, dma
->pgtbl_size
,
584 dma
->pgtbl
, dma
->pgtbl_map
);
592 static void cnic_setup_page_tbl(struct cnic_dev
*dev
, struct cnic_dma
*dma
)
595 u32
*page_table
= dma
->pgtbl
;
597 for (i
= 0; i
< dma
->num_pages
; i
++) {
598 /* Each entry needs to be in big endian format. */
599 *page_table
= (u32
) ((u64
) dma
->pg_map_arr
[i
] >> 32);
601 *page_table
= (u32
) dma
->pg_map_arr
[i
];
606 static int cnic_alloc_dma(struct cnic_dev
*dev
, struct cnic_dma
*dma
,
607 int pages
, int use_pg_tbl
)
610 struct cnic_local
*cp
= dev
->cnic_priv
;
612 size
= pages
* (sizeof(void *) + sizeof(dma_addr_t
));
613 dma
->pg_arr
= kzalloc(size
, GFP_ATOMIC
);
614 if (dma
->pg_arr
== NULL
)
617 dma
->pg_map_arr
= (dma_addr_t
*) (dma
->pg_arr
+ pages
);
618 dma
->num_pages
= pages
;
620 for (i
= 0; i
< pages
; i
++) {
621 dma
->pg_arr
[i
] = pci_alloc_consistent(dev
->pcidev
,
623 &dma
->pg_map_arr
[i
]);
624 if (dma
->pg_arr
[i
] == NULL
)
630 dma
->pgtbl_size
= ((pages
* 8) + BCM_PAGE_SIZE
- 1) &
631 ~(BCM_PAGE_SIZE
- 1);
632 dma
->pgtbl
= pci_alloc_consistent(dev
->pcidev
, dma
->pgtbl_size
,
634 if (dma
->pgtbl
== NULL
)
637 cp
->setup_pgtbl(dev
, dma
);
642 cnic_free_dma(dev
, dma
);
646 static void cnic_free_resc(struct cnic_dev
*dev
)
648 struct cnic_local
*cp
= dev
->cnic_priv
;
651 if (cp
->cnic_uinfo
) {
652 while (cp
->uio_dev
!= -1 && i
< 15) {
656 uio_unregister_device(cp
->cnic_uinfo
);
657 kfree(cp
->cnic_uinfo
);
658 cp
->cnic_uinfo
= NULL
;
662 pci_free_consistent(dev
->pcidev
, cp
->l2_buf_size
,
663 cp
->l2_buf
, cp
->l2_buf_map
);
668 pci_free_consistent(dev
->pcidev
, cp
->l2_ring_size
,
669 cp
->l2_ring
, cp
->l2_ring_map
);
673 for (i
= 0; i
< cp
->ctx_blks
; i
++) {
674 if (cp
->ctx_arr
[i
].ctx
) {
675 pci_free_consistent(dev
->pcidev
, cp
->ctx_blk_size
,
677 cp
->ctx_arr
[i
].mapping
);
678 cp
->ctx_arr
[i
].ctx
= NULL
;
685 cnic_free_dma(dev
, &cp
->gbl_buf_info
);
686 cnic_free_dma(dev
, &cp
->conn_buf_info
);
687 cnic_free_dma(dev
, &cp
->kwq_info
);
688 cnic_free_dma(dev
, &cp
->kcq_info
);
689 kfree(cp
->iscsi_tbl
);
690 cp
->iscsi_tbl
= NULL
;
694 cnic_free_id_tbl(&cp
->cid_tbl
);
697 static int cnic_alloc_context(struct cnic_dev
*dev
)
699 struct cnic_local
*cp
= dev
->cnic_priv
;
701 if (CHIP_NUM(cp
) == CHIP_NUM_5709
) {
704 cp
->ctx_blk_size
= BCM_PAGE_SIZE
;
705 cp
->cids_per_blk
= BCM_PAGE_SIZE
/ 128;
706 arr_size
= BNX2_MAX_CID
/ cp
->cids_per_blk
*
707 sizeof(struct cnic_ctx
);
708 cp
->ctx_arr
= kzalloc(arr_size
, GFP_KERNEL
);
709 if (cp
->ctx_arr
== NULL
)
713 for (i
= 0; i
< 2; i
++) {
714 u32 j
, reg
, off
, lo
, hi
;
717 off
= BNX2_PG_CTX_MAP
;
719 off
= BNX2_ISCSI_CTX_MAP
;
721 reg
= cnic_reg_rd_ind(dev
, off
);
724 for (j
= lo
; j
< hi
; j
+= cp
->cids_per_blk
, k
++)
725 cp
->ctx_arr
[k
].cid
= j
;
729 if (cp
->ctx_blks
>= (BNX2_MAX_CID
/ cp
->cids_per_blk
)) {
734 for (i
= 0; i
< cp
->ctx_blks
; i
++) {
736 pci_alloc_consistent(dev
->pcidev
, BCM_PAGE_SIZE
,
737 &cp
->ctx_arr
[i
].mapping
);
738 if (cp
->ctx_arr
[i
].ctx
== NULL
)
745 static int cnic_alloc_l2_rings(struct cnic_dev
*dev
, int pages
)
747 struct cnic_local
*cp
= dev
->cnic_priv
;
749 cp
->l2_ring_size
= pages
* BCM_PAGE_SIZE
;
750 cp
->l2_ring
= pci_alloc_consistent(dev
->pcidev
, cp
->l2_ring_size
,
755 cp
->l2_buf_size
= (cp
->l2_rx_ring_size
+ 1) * cp
->l2_single_buf_size
;
756 cp
->l2_buf_size
= PAGE_ALIGN(cp
->l2_buf_size
);
757 cp
->l2_buf
= pci_alloc_consistent(dev
->pcidev
, cp
->l2_buf_size
,
765 static int cnic_alloc_uio(struct cnic_dev
*dev
) {
766 struct cnic_local
*cp
= dev
->cnic_priv
;
767 struct uio_info
*uinfo
;
770 uinfo
= kzalloc(sizeof(*uinfo
), GFP_ATOMIC
);
774 uinfo
->mem
[0].addr
= dev
->netdev
->base_addr
;
775 uinfo
->mem
[0].internal_addr
= dev
->regview
;
776 uinfo
->mem
[0].size
= dev
->netdev
->mem_end
- dev
->netdev
->mem_start
;
777 uinfo
->mem
[0].memtype
= UIO_MEM_PHYS
;
779 uinfo
->mem
[1].addr
= (unsigned long) cp
->status_blk
& PAGE_MASK
;
780 if (test_bit(CNIC_F_BNX2_CLASS
, &dev
->flags
)) {
781 if (cp
->ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
)
782 uinfo
->mem
[1].size
= BNX2_SBLK_MSIX_ALIGN_SIZE
* 9;
784 uinfo
->mem
[1].size
= BNX2_SBLK_MSIX_ALIGN_SIZE
;
786 uinfo
->name
= "bnx2_cnic";
789 uinfo
->mem
[1].memtype
= UIO_MEM_LOGICAL
;
791 uinfo
->mem
[2].addr
= (unsigned long) cp
->l2_ring
;
792 uinfo
->mem
[2].size
= cp
->l2_ring_size
;
793 uinfo
->mem
[2].memtype
= UIO_MEM_LOGICAL
;
795 uinfo
->mem
[3].addr
= (unsigned long) cp
->l2_buf
;
796 uinfo
->mem
[3].size
= cp
->l2_buf_size
;
797 uinfo
->mem
[3].memtype
= UIO_MEM_LOGICAL
;
799 uinfo
->version
= CNIC_MODULE_VERSION
;
800 uinfo
->irq
= UIO_IRQ_CUSTOM
;
802 uinfo
->open
= cnic_uio_open
;
803 uinfo
->release
= cnic_uio_close
;
807 ret
= uio_register_device(&dev
->pcidev
->dev
, uinfo
);
813 cp
->cnic_uinfo
= uinfo
;
817 static int cnic_alloc_bnx2_resc(struct cnic_dev
*dev
)
819 struct cnic_local
*cp
= dev
->cnic_priv
;
822 ret
= cnic_alloc_dma(dev
, &cp
->kwq_info
, KWQ_PAGE_CNT
, 1);
825 cp
->kwq
= (struct kwqe
**) cp
->kwq_info
.pg_arr
;
827 ret
= cnic_alloc_dma(dev
, &cp
->kcq_info
, KCQ_PAGE_CNT
, 1);
830 cp
->kcq
= (struct kcqe
**) cp
->kcq_info
.pg_arr
;
832 ret
= cnic_alloc_context(dev
);
836 ret
= cnic_alloc_l2_rings(dev
, 2);
840 ret
= cnic_alloc_uio(dev
);
851 static inline u32
cnic_kwq_avail(struct cnic_local
*cp
)
853 return cp
->max_kwq_idx
-
854 ((cp
->kwq_prod_idx
- cp
->kwq_con_idx
) & cp
->max_kwq_idx
);
857 static int cnic_submit_bnx2_kwqes(struct cnic_dev
*dev
, struct kwqe
*wqes
[],
860 struct cnic_local
*cp
= dev
->cnic_priv
;
861 struct kwqe
*prod_qe
;
862 u16 prod
, sw_prod
, i
;
864 if (!test_bit(CNIC_F_CNIC_UP
, &dev
->flags
))
865 return -EAGAIN
; /* bnx2 is down */
867 spin_lock_bh(&cp
->cnic_ulp_lock
);
868 if (num_wqes
> cnic_kwq_avail(cp
) &&
869 !(cp
->cnic_local_flags
& CNIC_LCL_FL_KWQ_INIT
)) {
870 spin_unlock_bh(&cp
->cnic_ulp_lock
);
874 cp
->cnic_local_flags
&= ~CNIC_LCL_FL_KWQ_INIT
;
876 prod
= cp
->kwq_prod_idx
;
877 sw_prod
= prod
& MAX_KWQ_IDX
;
878 for (i
= 0; i
< num_wqes
; i
++) {
879 prod_qe
= &cp
->kwq
[KWQ_PG(sw_prod
)][KWQ_IDX(sw_prod
)];
880 memcpy(prod_qe
, wqes
[i
], sizeof(struct kwqe
));
882 sw_prod
= prod
& MAX_KWQ_IDX
;
884 cp
->kwq_prod_idx
= prod
;
886 CNIC_WR16(dev
, cp
->kwq_io_addr
, cp
->kwq_prod_idx
);
888 spin_unlock_bh(&cp
->cnic_ulp_lock
);
892 static void service_kcqes(struct cnic_dev
*dev
, int num_cqes
)
894 struct cnic_local
*cp
= dev
->cnic_priv
;
900 struct cnic_ulp_ops
*ulp_ops
;
902 u32 kcqe_op_flag
= cp
->completed_kcq
[i
]->kcqe_op_flag
;
903 u32 kcqe_layer
= kcqe_op_flag
& KCQE_FLAGS_LAYER_MASK
;
905 if (unlikely(kcqe_op_flag
& KCQE_RAMROD_COMPLETION
))
906 cnic_kwq_completion(dev
, 1);
908 while (j
< num_cqes
) {
909 u32 next_op
= cp
->completed_kcq
[i
+ j
]->kcqe_op_flag
;
911 if ((next_op
& KCQE_FLAGS_LAYER_MASK
) != kcqe_layer
)
914 if (unlikely(next_op
& KCQE_RAMROD_COMPLETION
))
915 cnic_kwq_completion(dev
, 1);
919 if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L5_RDMA
)
920 ulp_type
= CNIC_ULP_RDMA
;
921 else if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L5_ISCSI
)
922 ulp_type
= CNIC_ULP_ISCSI
;
923 else if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L4
)
924 ulp_type
= CNIC_ULP_L4
;
925 else if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L2
)
928 printk(KERN_ERR PFX
"%s: Unknown type of KCQE(0x%x)\n",
929 dev
->netdev
->name
, kcqe_op_flag
);
934 ulp_ops
= rcu_dereference(cp
->ulp_ops
[ulp_type
]);
935 if (likely(ulp_ops
)) {
936 ulp_ops
->indicate_kcqes(cp
->ulp_handle
[ulp_type
],
937 cp
->completed_kcq
+ i
, j
);
948 static u16
cnic_bnx2_next_idx(u16 idx
)
953 static u16
cnic_bnx2_hw_idx(u16 idx
)
958 static int cnic_get_kcqes(struct cnic_dev
*dev
, u16 hw_prod
, u16
*sw_prod
)
960 struct cnic_local
*cp
= dev
->cnic_priv
;
963 int kcqe_cnt
= 0, last_cnt
= 0;
965 i
= ri
= last
= *sw_prod
;
968 while ((i
!= hw_prod
) && (kcqe_cnt
< MAX_COMPLETED_KCQE
)) {
969 kcqe
= &cp
->kcq
[KCQ_PG(ri
)][KCQ_IDX(ri
)];
970 cp
->completed_kcq
[kcqe_cnt
++] = kcqe
;
972 ri
= i
& MAX_KCQ_IDX
;
973 if (likely(!(kcqe
->kcqe_op_flag
& KCQE_FLAGS_NEXT
))) {
983 static void cnic_chk_bnx2_pkt_rings(struct cnic_local
*cp
)
985 u16 rx_cons
= *cp
->rx_cons_ptr
;
986 u16 tx_cons
= *cp
->tx_cons_ptr
;
988 if (cp
->tx_cons
!= tx_cons
|| cp
->rx_cons
!= rx_cons
) {
989 cp
->tx_cons
= tx_cons
;
990 cp
->rx_cons
= rx_cons
;
991 uio_event_notify(cp
->cnic_uinfo
);
995 static int cnic_service_bnx2(void *data
, void *status_blk
)
997 struct cnic_dev
*dev
= data
;
998 struct status_block
*sblk
= status_blk
;
999 struct cnic_local
*cp
= dev
->cnic_priv
;
1000 u32 status_idx
= sblk
->status_idx
;
1001 u16 hw_prod
, sw_prod
;
1004 if (unlikely(!test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)))
1007 cp
->kwq_con_idx
= *cp
->kwq_con_idx_ptr
;
1009 hw_prod
= sblk
->status_completion_producer_index
;
1010 sw_prod
= cp
->kcq_prod_idx
;
1011 while (sw_prod
!= hw_prod
) {
1012 kcqe_cnt
= cnic_get_kcqes(dev
, hw_prod
, &sw_prod
);
1016 service_kcqes(dev
, kcqe_cnt
);
1018 /* Tell compiler that status_blk fields can change. */
1020 if (status_idx
!= sblk
->status_idx
) {
1021 status_idx
= sblk
->status_idx
;
1022 cp
->kwq_con_idx
= *cp
->kwq_con_idx_ptr
;
1023 hw_prod
= sblk
->status_completion_producer_index
;
1029 CNIC_WR16(dev
, cp
->kcq_io_addr
, sw_prod
);
1031 cp
->kcq_prod_idx
= sw_prod
;
1033 cnic_chk_bnx2_pkt_rings(cp
);
1037 static void cnic_service_bnx2_msix(unsigned long data
)
1039 struct cnic_dev
*dev
= (struct cnic_dev
*) data
;
1040 struct cnic_local
*cp
= dev
->cnic_priv
;
1041 struct status_block_msix
*status_blk
= cp
->bnx2_status_blk
;
1042 u32 status_idx
= status_blk
->status_idx
;
1043 u16 hw_prod
, sw_prod
;
1046 cp
->kwq_con_idx
= status_blk
->status_cmd_consumer_index
;
1048 hw_prod
= status_blk
->status_completion_producer_index
;
1049 sw_prod
= cp
->kcq_prod_idx
;
1050 while (sw_prod
!= hw_prod
) {
1051 kcqe_cnt
= cnic_get_kcqes(dev
, hw_prod
, &sw_prod
);
1055 service_kcqes(dev
, kcqe_cnt
);
1057 /* Tell compiler that status_blk fields can change. */
1059 if (status_idx
!= status_blk
->status_idx
) {
1060 status_idx
= status_blk
->status_idx
;
1061 cp
->kwq_con_idx
= status_blk
->status_cmd_consumer_index
;
1062 hw_prod
= status_blk
->status_completion_producer_index
;
1068 CNIC_WR16(dev
, cp
->kcq_io_addr
, sw_prod
);
1069 cp
->kcq_prod_idx
= sw_prod
;
1071 cnic_chk_bnx2_pkt_rings(cp
);
1073 cp
->last_status_idx
= status_idx
;
1074 CNIC_WR(dev
, BNX2_PCICFG_INT_ACK_CMD
, cp
->int_num
|
1075 BNX2_PCICFG_INT_ACK_CMD_INDEX_VALID
| cp
->last_status_idx
);
1078 static irqreturn_t
cnic_irq(int irq
, void *dev_instance
)
1080 struct cnic_dev
*dev
= dev_instance
;
1081 struct cnic_local
*cp
= dev
->cnic_priv
;
1082 u16 prod
= cp
->kcq_prod_idx
& MAX_KCQ_IDX
;
1087 prefetch(cp
->status_blk
);
1088 prefetch(&cp
->kcq
[KCQ_PG(prod
)][KCQ_IDX(prod
)]);
1090 if (likely(test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)))
1091 tasklet_schedule(&cp
->cnic_irq_task
);
1096 static void cnic_ulp_stop(struct cnic_dev
*dev
)
1098 struct cnic_local
*cp
= dev
->cnic_priv
;
1102 cnic_send_nlmsg(cp
, ISCSI_KEVENT_IF_DOWN
, NULL
);
1105 for (if_type
= 0; if_type
< MAX_CNIC_ULP_TYPE
; if_type
++) {
1106 struct cnic_ulp_ops
*ulp_ops
;
1108 ulp_ops
= rcu_dereference(cp
->ulp_ops
[if_type
]);
1112 if (test_and_clear_bit(ULP_F_START
, &cp
->ulp_flags
[if_type
]))
1113 ulp_ops
->cnic_stop(cp
->ulp_handle
[if_type
]);
1118 static void cnic_ulp_start(struct cnic_dev
*dev
)
1120 struct cnic_local
*cp
= dev
->cnic_priv
;
1124 for (if_type
= 0; if_type
< MAX_CNIC_ULP_TYPE
; if_type
++) {
1125 struct cnic_ulp_ops
*ulp_ops
;
1127 ulp_ops
= rcu_dereference(cp
->ulp_ops
[if_type
]);
1128 if (!ulp_ops
|| !ulp_ops
->cnic_start
)
1131 if (!test_and_set_bit(ULP_F_START
, &cp
->ulp_flags
[if_type
]))
1132 ulp_ops
->cnic_start(cp
->ulp_handle
[if_type
]);
1137 static int cnic_ctl(void *data
, struct cnic_ctl_info
*info
)
1139 struct cnic_dev
*dev
= data
;
1141 switch (info
->cmd
) {
1142 case CNIC_CTL_STOP_CMD
:
1144 mutex_lock(&cnic_lock
);
1149 mutex_unlock(&cnic_lock
);
1152 case CNIC_CTL_START_CMD
:
1154 mutex_lock(&cnic_lock
);
1156 if (!cnic_start_hw(dev
))
1157 cnic_ulp_start(dev
);
1159 mutex_unlock(&cnic_lock
);
1168 static void cnic_ulp_init(struct cnic_dev
*dev
)
1171 struct cnic_local
*cp
= dev
->cnic_priv
;
1174 for (i
= 0; i
< MAX_CNIC_ULP_TYPE_EXT
; i
++) {
1175 struct cnic_ulp_ops
*ulp_ops
;
1177 ulp_ops
= rcu_dereference(cnic_ulp_tbl
[i
]);
1178 if (!ulp_ops
|| !ulp_ops
->cnic_init
)
1181 if (!test_and_set_bit(ULP_F_INIT
, &cp
->ulp_flags
[i
]))
1182 ulp_ops
->cnic_init(dev
);
1188 static void cnic_ulp_exit(struct cnic_dev
*dev
)
1191 struct cnic_local
*cp
= dev
->cnic_priv
;
1194 for (i
= 0; i
< MAX_CNIC_ULP_TYPE_EXT
; i
++) {
1195 struct cnic_ulp_ops
*ulp_ops
;
1197 ulp_ops
= rcu_dereference(cnic_ulp_tbl
[i
]);
1198 if (!ulp_ops
|| !ulp_ops
->cnic_exit
)
1201 if (test_and_clear_bit(ULP_F_INIT
, &cp
->ulp_flags
[i
]))
1202 ulp_ops
->cnic_exit(dev
);
1208 static int cnic_cm_offload_pg(struct cnic_sock
*csk
)
1210 struct cnic_dev
*dev
= csk
->dev
;
1211 struct l4_kwq_offload_pg
*l4kwqe
;
1212 struct kwqe
*wqes
[1];
1214 l4kwqe
= (struct l4_kwq_offload_pg
*) &csk
->kwqe1
;
1215 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1216 wqes
[0] = (struct kwqe
*) l4kwqe
;
1218 l4kwqe
->op_code
= L4_KWQE_OPCODE_VALUE_OFFLOAD_PG
;
1220 L4_LAYER_CODE
<< L4_KWQ_OFFLOAD_PG_LAYER_CODE_SHIFT
;
1221 l4kwqe
->l2hdr_nbytes
= ETH_HLEN
;
1223 l4kwqe
->da0
= csk
->ha
[0];
1224 l4kwqe
->da1
= csk
->ha
[1];
1225 l4kwqe
->da2
= csk
->ha
[2];
1226 l4kwqe
->da3
= csk
->ha
[3];
1227 l4kwqe
->da4
= csk
->ha
[4];
1228 l4kwqe
->da5
= csk
->ha
[5];
1230 l4kwqe
->sa0
= dev
->mac_addr
[0];
1231 l4kwqe
->sa1
= dev
->mac_addr
[1];
1232 l4kwqe
->sa2
= dev
->mac_addr
[2];
1233 l4kwqe
->sa3
= dev
->mac_addr
[3];
1234 l4kwqe
->sa4
= dev
->mac_addr
[4];
1235 l4kwqe
->sa5
= dev
->mac_addr
[5];
1237 l4kwqe
->etype
= ETH_P_IP
;
1238 l4kwqe
->ipid_count
= DEF_IPID_COUNT
;
1239 l4kwqe
->host_opaque
= csk
->l5_cid
;
1242 l4kwqe
->pg_flags
|= L4_KWQ_OFFLOAD_PG_VLAN_TAGGING
;
1243 l4kwqe
->vlan_tag
= csk
->vlan_id
;
1244 l4kwqe
->l2hdr_nbytes
+= 4;
1247 return dev
->submit_kwqes(dev
, wqes
, 1);
1250 static int cnic_cm_update_pg(struct cnic_sock
*csk
)
1252 struct cnic_dev
*dev
= csk
->dev
;
1253 struct l4_kwq_update_pg
*l4kwqe
;
1254 struct kwqe
*wqes
[1];
1256 l4kwqe
= (struct l4_kwq_update_pg
*) &csk
->kwqe1
;
1257 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1258 wqes
[0] = (struct kwqe
*) l4kwqe
;
1260 l4kwqe
->opcode
= L4_KWQE_OPCODE_VALUE_UPDATE_PG
;
1262 L4_LAYER_CODE
<< L4_KWQ_UPDATE_PG_LAYER_CODE_SHIFT
;
1263 l4kwqe
->pg_cid
= csk
->pg_cid
;
1265 l4kwqe
->da0
= csk
->ha
[0];
1266 l4kwqe
->da1
= csk
->ha
[1];
1267 l4kwqe
->da2
= csk
->ha
[2];
1268 l4kwqe
->da3
= csk
->ha
[3];
1269 l4kwqe
->da4
= csk
->ha
[4];
1270 l4kwqe
->da5
= csk
->ha
[5];
1272 l4kwqe
->pg_host_opaque
= csk
->l5_cid
;
1273 l4kwqe
->pg_valids
= L4_KWQ_UPDATE_PG_VALIDS_DA
;
1275 return dev
->submit_kwqes(dev
, wqes
, 1);
1278 static int cnic_cm_upload_pg(struct cnic_sock
*csk
)
1280 struct cnic_dev
*dev
= csk
->dev
;
1281 struct l4_kwq_upload
*l4kwqe
;
1282 struct kwqe
*wqes
[1];
1284 l4kwqe
= (struct l4_kwq_upload
*) &csk
->kwqe1
;
1285 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1286 wqes
[0] = (struct kwqe
*) l4kwqe
;
1288 l4kwqe
->opcode
= L4_KWQE_OPCODE_VALUE_UPLOAD_PG
;
1290 L4_LAYER_CODE
<< L4_KWQ_UPLOAD_LAYER_CODE_SHIFT
;
1291 l4kwqe
->cid
= csk
->pg_cid
;
1293 return dev
->submit_kwqes(dev
, wqes
, 1);
1296 static int cnic_cm_conn_req(struct cnic_sock
*csk
)
1298 struct cnic_dev
*dev
= csk
->dev
;
1299 struct l4_kwq_connect_req1
*l4kwqe1
;
1300 struct l4_kwq_connect_req2
*l4kwqe2
;
1301 struct l4_kwq_connect_req3
*l4kwqe3
;
1302 struct kwqe
*wqes
[3];
1306 l4kwqe1
= (struct l4_kwq_connect_req1
*) &csk
->kwqe1
;
1307 l4kwqe2
= (struct l4_kwq_connect_req2
*) &csk
->kwqe2
;
1308 l4kwqe3
= (struct l4_kwq_connect_req3
*) &csk
->kwqe3
;
1309 memset(l4kwqe1
, 0, sizeof(*l4kwqe1
));
1310 memset(l4kwqe2
, 0, sizeof(*l4kwqe2
));
1311 memset(l4kwqe3
, 0, sizeof(*l4kwqe3
));
1313 l4kwqe3
->op_code
= L4_KWQE_OPCODE_VALUE_CONNECT3
;
1315 L4_LAYER_CODE
<< L4_KWQ_CONNECT_REQ3_LAYER_CODE_SHIFT
;
1316 l4kwqe3
->ka_timeout
= csk
->ka_timeout
;
1317 l4kwqe3
->ka_interval
= csk
->ka_interval
;
1318 l4kwqe3
->ka_max_probe_count
= csk
->ka_max_probe_count
;
1319 l4kwqe3
->tos
= csk
->tos
;
1320 l4kwqe3
->ttl
= csk
->ttl
;
1321 l4kwqe3
->snd_seq_scale
= csk
->snd_seq_scale
;
1322 l4kwqe3
->pmtu
= csk
->mtu
;
1323 l4kwqe3
->rcv_buf
= csk
->rcv_buf
;
1324 l4kwqe3
->snd_buf
= csk
->snd_buf
;
1325 l4kwqe3
->seed
= csk
->seed
;
1327 wqes
[0] = (struct kwqe
*) l4kwqe1
;
1328 if (test_bit(SK_F_IPV6
, &csk
->flags
)) {
1329 wqes
[1] = (struct kwqe
*) l4kwqe2
;
1330 wqes
[2] = (struct kwqe
*) l4kwqe3
;
1333 l4kwqe1
->conn_flags
= L4_KWQ_CONNECT_REQ1_IP_V6
;
1334 l4kwqe2
->op_code
= L4_KWQE_OPCODE_VALUE_CONNECT2
;
1336 L4_KWQ_CONNECT_REQ2_LINKED_WITH_NEXT
|
1337 L4_LAYER_CODE
<< L4_KWQ_CONNECT_REQ2_LAYER_CODE_SHIFT
;
1338 l4kwqe2
->src_ip_v6_2
= be32_to_cpu(csk
->src_ip
[1]);
1339 l4kwqe2
->src_ip_v6_3
= be32_to_cpu(csk
->src_ip
[2]);
1340 l4kwqe2
->src_ip_v6_4
= be32_to_cpu(csk
->src_ip
[3]);
1341 l4kwqe2
->dst_ip_v6_2
= be32_to_cpu(csk
->dst_ip
[1]);
1342 l4kwqe2
->dst_ip_v6_3
= be32_to_cpu(csk
->dst_ip
[2]);
1343 l4kwqe2
->dst_ip_v6_4
= be32_to_cpu(csk
->dst_ip
[3]);
1344 l4kwqe3
->mss
= l4kwqe3
->pmtu
- sizeof(struct ipv6hdr
) -
1345 sizeof(struct tcphdr
);
1347 wqes
[1] = (struct kwqe
*) l4kwqe3
;
1348 l4kwqe3
->mss
= l4kwqe3
->pmtu
- sizeof(struct iphdr
) -
1349 sizeof(struct tcphdr
);
1352 l4kwqe1
->op_code
= L4_KWQE_OPCODE_VALUE_CONNECT1
;
1354 (L4_LAYER_CODE
<< L4_KWQ_CONNECT_REQ1_LAYER_CODE_SHIFT
) |
1355 L4_KWQ_CONNECT_REQ3_LINKED_WITH_NEXT
;
1356 l4kwqe1
->cid
= csk
->cid
;
1357 l4kwqe1
->pg_cid
= csk
->pg_cid
;
1358 l4kwqe1
->src_ip
= be32_to_cpu(csk
->src_ip
[0]);
1359 l4kwqe1
->dst_ip
= be32_to_cpu(csk
->dst_ip
[0]);
1360 l4kwqe1
->src_port
= be16_to_cpu(csk
->src_port
);
1361 l4kwqe1
->dst_port
= be16_to_cpu(csk
->dst_port
);
1362 if (csk
->tcp_flags
& SK_TCP_NO_DELAY_ACK
)
1363 tcp_flags
|= L4_KWQ_CONNECT_REQ1_NO_DELAY_ACK
;
1364 if (csk
->tcp_flags
& SK_TCP_KEEP_ALIVE
)
1365 tcp_flags
|= L4_KWQ_CONNECT_REQ1_KEEP_ALIVE
;
1366 if (csk
->tcp_flags
& SK_TCP_NAGLE
)
1367 tcp_flags
|= L4_KWQ_CONNECT_REQ1_NAGLE_ENABLE
;
1368 if (csk
->tcp_flags
& SK_TCP_TIMESTAMP
)
1369 tcp_flags
|= L4_KWQ_CONNECT_REQ1_TIME_STAMP
;
1370 if (csk
->tcp_flags
& SK_TCP_SACK
)
1371 tcp_flags
|= L4_KWQ_CONNECT_REQ1_SACK
;
1372 if (csk
->tcp_flags
& SK_TCP_SEG_SCALING
)
1373 tcp_flags
|= L4_KWQ_CONNECT_REQ1_SEG_SCALING
;
1375 l4kwqe1
->tcp_flags
= tcp_flags
;
1377 return dev
->submit_kwqes(dev
, wqes
, num_wqes
);
1380 static int cnic_cm_close_req(struct cnic_sock
*csk
)
1382 struct cnic_dev
*dev
= csk
->dev
;
1383 struct l4_kwq_close_req
*l4kwqe
;
1384 struct kwqe
*wqes
[1];
1386 l4kwqe
= (struct l4_kwq_close_req
*) &csk
->kwqe2
;
1387 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1388 wqes
[0] = (struct kwqe
*) l4kwqe
;
1390 l4kwqe
->op_code
= L4_KWQE_OPCODE_VALUE_CLOSE
;
1391 l4kwqe
->flags
= L4_LAYER_CODE
<< L4_KWQ_CLOSE_REQ_LAYER_CODE_SHIFT
;
1392 l4kwqe
->cid
= csk
->cid
;
1394 return dev
->submit_kwqes(dev
, wqes
, 1);
1397 static int cnic_cm_abort_req(struct cnic_sock
*csk
)
1399 struct cnic_dev
*dev
= csk
->dev
;
1400 struct l4_kwq_reset_req
*l4kwqe
;
1401 struct kwqe
*wqes
[1];
1403 l4kwqe
= (struct l4_kwq_reset_req
*) &csk
->kwqe2
;
1404 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1405 wqes
[0] = (struct kwqe
*) l4kwqe
;
1407 l4kwqe
->op_code
= L4_KWQE_OPCODE_VALUE_RESET
;
1408 l4kwqe
->flags
= L4_LAYER_CODE
<< L4_KWQ_RESET_REQ_LAYER_CODE_SHIFT
;
1409 l4kwqe
->cid
= csk
->cid
;
1411 return dev
->submit_kwqes(dev
, wqes
, 1);
1414 static int cnic_cm_create(struct cnic_dev
*dev
, int ulp_type
, u32 cid
,
1415 u32 l5_cid
, struct cnic_sock
**csk
, void *context
)
1417 struct cnic_local
*cp
= dev
->cnic_priv
;
1418 struct cnic_sock
*csk1
;
1420 if (l5_cid
>= MAX_CM_SK_TBL_SZ
)
1423 csk1
= &cp
->csk_tbl
[l5_cid
];
1424 if (atomic_read(&csk1
->ref_count
))
1427 if (test_and_set_bit(SK_F_INUSE
, &csk1
->flags
))
1432 csk1
->l5_cid
= l5_cid
;
1433 csk1
->ulp_type
= ulp_type
;
1434 csk1
->context
= context
;
1436 csk1
->ka_timeout
= DEF_KA_TIMEOUT
;
1437 csk1
->ka_interval
= DEF_KA_INTERVAL
;
1438 csk1
->ka_max_probe_count
= DEF_KA_MAX_PROBE_COUNT
;
1439 csk1
->tos
= DEF_TOS
;
1440 csk1
->ttl
= DEF_TTL
;
1441 csk1
->snd_seq_scale
= DEF_SND_SEQ_SCALE
;
1442 csk1
->rcv_buf
= DEF_RCV_BUF
;
1443 csk1
->snd_buf
= DEF_SND_BUF
;
1444 csk1
->seed
= DEF_SEED
;
1450 static void cnic_cm_cleanup(struct cnic_sock
*csk
)
1452 if (csk
->src_port
) {
1453 struct cnic_dev
*dev
= csk
->dev
;
1454 struct cnic_local
*cp
= dev
->cnic_priv
;
1456 cnic_free_id(&cp
->csk_port_tbl
, csk
->src_port
);
1461 static void cnic_close_conn(struct cnic_sock
*csk
)
1463 if (test_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
)) {
1464 cnic_cm_upload_pg(csk
);
1465 clear_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
);
1467 cnic_cm_cleanup(csk
);
1470 static int cnic_cm_destroy(struct cnic_sock
*csk
)
1472 if (!cnic_in_use(csk
))
1476 clear_bit(SK_F_INUSE
, &csk
->flags
);
1477 smp_mb__after_clear_bit();
1478 while (atomic_read(&csk
->ref_count
) != 1)
1480 cnic_cm_cleanup(csk
);
1487 static inline u16
cnic_get_vlan(struct net_device
*dev
,
1488 struct net_device
**vlan_dev
)
1490 if (dev
->priv_flags
& IFF_802_1Q_VLAN
) {
1491 *vlan_dev
= vlan_dev_real_dev(dev
);
1492 return vlan_dev_vlan_id(dev
);
1498 static int cnic_get_v4_route(struct sockaddr_in
*dst_addr
,
1499 struct dst_entry
**dst
)
1501 #if defined(CONFIG_INET)
1506 memset(&fl
, 0, sizeof(fl
));
1507 fl
.nl_u
.ip4_u
.daddr
= dst_addr
->sin_addr
.s_addr
;
1509 err
= ip_route_output_key(&init_net
, &rt
, &fl
);
1514 return -ENETUNREACH
;
1518 static int cnic_get_v6_route(struct sockaddr_in6
*dst_addr
,
1519 struct dst_entry
**dst
)
1521 #if defined(CONFIG_IPV6) || (defined(CONFIG_IPV6_MODULE) && defined(MODULE))
1524 memset(&fl
, 0, sizeof(fl
));
1525 ipv6_addr_copy(&fl
.fl6_dst
, &dst_addr
->sin6_addr
);
1526 if (ipv6_addr_type(&fl
.fl6_dst
) & IPV6_ADDR_LINKLOCAL
)
1527 fl
.oif
= dst_addr
->sin6_scope_id
;
1529 *dst
= ip6_route_output(&init_net
, NULL
, &fl
);
1534 return -ENETUNREACH
;
1537 static struct cnic_dev
*cnic_cm_select_dev(struct sockaddr_in
*dst_addr
,
1540 struct cnic_dev
*dev
= NULL
;
1541 struct dst_entry
*dst
;
1542 struct net_device
*netdev
= NULL
;
1543 int err
= -ENETUNREACH
;
1545 if (dst_addr
->sin_family
== AF_INET
)
1546 err
= cnic_get_v4_route(dst_addr
, &dst
);
1547 else if (dst_addr
->sin_family
== AF_INET6
) {
1548 struct sockaddr_in6
*dst_addr6
=
1549 (struct sockaddr_in6
*) dst_addr
;
1551 err
= cnic_get_v6_route(dst_addr6
, &dst
);
1561 cnic_get_vlan(dst
->dev
, &netdev
);
1563 dev
= cnic_from_netdev(netdev
);
1572 static int cnic_resolve_addr(struct cnic_sock
*csk
, struct cnic_sockaddr
*saddr
)
1574 struct cnic_dev
*dev
= csk
->dev
;
1575 struct cnic_local
*cp
= dev
->cnic_priv
;
1577 return cnic_send_nlmsg(cp
, ISCSI_KEVENT_PATH_REQ
, csk
);
1580 static int cnic_get_route(struct cnic_sock
*csk
, struct cnic_sockaddr
*saddr
)
1582 struct cnic_dev
*dev
= csk
->dev
;
1583 struct cnic_local
*cp
= dev
->cnic_priv
;
1584 int is_v6
, err
, rc
= -ENETUNREACH
;
1585 struct dst_entry
*dst
;
1586 struct net_device
*realdev
;
1589 if (saddr
->local
.v6
.sin6_family
== AF_INET6
&&
1590 saddr
->remote
.v6
.sin6_family
== AF_INET6
)
1592 else if (saddr
->local
.v4
.sin_family
== AF_INET
&&
1593 saddr
->remote
.v4
.sin_family
== AF_INET
)
1598 clear_bit(SK_F_IPV6
, &csk
->flags
);
1601 #if defined(CONFIG_IPV6) || (defined(CONFIG_IPV6_MODULE) && defined(MODULE))
1602 set_bit(SK_F_IPV6
, &csk
->flags
);
1603 err
= cnic_get_v6_route(&saddr
->remote
.v6
, &dst
);
1607 if (!dst
|| dst
->error
|| !dst
->dev
)
1610 memcpy(&csk
->dst_ip
[0], &saddr
->remote
.v6
.sin6_addr
,
1611 sizeof(struct in6_addr
));
1612 csk
->dst_port
= saddr
->remote
.v6
.sin6_port
;
1613 local_port
= saddr
->local
.v6
.sin6_port
;
1619 err
= cnic_get_v4_route(&saddr
->remote
.v4
, &dst
);
1623 if (!dst
|| dst
->error
|| !dst
->dev
)
1626 csk
->dst_ip
[0] = saddr
->remote
.v4
.sin_addr
.s_addr
;
1627 csk
->dst_port
= saddr
->remote
.v4
.sin_port
;
1628 local_port
= saddr
->local
.v4
.sin_port
;
1631 csk
->vlan_id
= cnic_get_vlan(dst
->dev
, &realdev
);
1632 if (realdev
!= dev
->netdev
)
1635 if (local_port
>= CNIC_LOCAL_PORT_MIN
&&
1636 local_port
< CNIC_LOCAL_PORT_MAX
) {
1637 if (cnic_alloc_id(&cp
->csk_port_tbl
, local_port
))
1643 local_port
= cnic_alloc_new_id(&cp
->csk_port_tbl
);
1644 if (local_port
== -1) {
1649 csk
->src_port
= local_port
;
1651 csk
->mtu
= dst_mtu(dst
);
1659 static void cnic_init_csk_state(struct cnic_sock
*csk
)
1662 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
1663 clear_bit(SK_F_CLOSING
, &csk
->flags
);
1666 static int cnic_cm_connect(struct cnic_sock
*csk
, struct cnic_sockaddr
*saddr
)
1670 if (!cnic_in_use(csk
))
1673 if (test_and_set_bit(SK_F_CONNECT_START
, &csk
->flags
))
1676 cnic_init_csk_state(csk
);
1678 err
= cnic_get_route(csk
, saddr
);
1682 err
= cnic_resolve_addr(csk
, saddr
);
1687 clear_bit(SK_F_CONNECT_START
, &csk
->flags
);
1691 static int cnic_cm_abort(struct cnic_sock
*csk
)
1693 struct cnic_local
*cp
= csk
->dev
->cnic_priv
;
1696 if (!cnic_in_use(csk
))
1699 if (cnic_abort_prep(csk
))
1700 return cnic_cm_abort_req(csk
);
1702 /* Getting here means that we haven't started connect, or
1703 * connect was not successful.
1706 csk
->state
= L4_KCQE_OPCODE_VALUE_RESET_COMP
;
1707 if (test_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
))
1708 opcode
= csk
->state
;
1710 opcode
= L5CM_RAMROD_CMD_ID_TERMINATE_OFFLOAD
;
1711 cp
->close_conn(csk
, opcode
);
1716 static int cnic_cm_close(struct cnic_sock
*csk
)
1718 if (!cnic_in_use(csk
))
1721 if (cnic_close_prep(csk
)) {
1722 csk
->state
= L4_KCQE_OPCODE_VALUE_CLOSE_COMP
;
1723 return cnic_cm_close_req(csk
);
1728 static void cnic_cm_upcall(struct cnic_local
*cp
, struct cnic_sock
*csk
,
1731 struct cnic_ulp_ops
*ulp_ops
;
1732 int ulp_type
= csk
->ulp_type
;
1735 ulp_ops
= rcu_dereference(cp
->ulp_ops
[ulp_type
]);
1737 if (opcode
== L4_KCQE_OPCODE_VALUE_CONNECT_COMPLETE
)
1738 ulp_ops
->cm_connect_complete(csk
);
1739 else if (opcode
== L4_KCQE_OPCODE_VALUE_CLOSE_COMP
)
1740 ulp_ops
->cm_close_complete(csk
);
1741 else if (opcode
== L4_KCQE_OPCODE_VALUE_RESET_RECEIVED
)
1742 ulp_ops
->cm_remote_abort(csk
);
1743 else if (opcode
== L4_KCQE_OPCODE_VALUE_RESET_COMP
)
1744 ulp_ops
->cm_abort_complete(csk
);
1745 else if (opcode
== L4_KCQE_OPCODE_VALUE_CLOSE_RECEIVED
)
1746 ulp_ops
->cm_remote_close(csk
);
1751 static int cnic_cm_set_pg(struct cnic_sock
*csk
)
1753 if (cnic_offld_prep(csk
)) {
1754 if (test_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
))
1755 cnic_cm_update_pg(csk
);
1757 cnic_cm_offload_pg(csk
);
1762 static void cnic_cm_process_offld_pg(struct cnic_dev
*dev
, struct l4_kcq
*kcqe
)
1764 struct cnic_local
*cp
= dev
->cnic_priv
;
1765 u32 l5_cid
= kcqe
->pg_host_opaque
;
1766 u8 opcode
= kcqe
->op_code
;
1767 struct cnic_sock
*csk
= &cp
->csk_tbl
[l5_cid
];
1770 if (!cnic_in_use(csk
))
1773 if (opcode
== L4_KCQE_OPCODE_VALUE_UPDATE_PG
) {
1774 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
1777 csk
->pg_cid
= kcqe
->pg_cid
;
1778 set_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
);
1779 cnic_cm_conn_req(csk
);
1785 static void cnic_cm_process_kcqe(struct cnic_dev
*dev
, struct kcqe
*kcqe
)
1787 struct cnic_local
*cp
= dev
->cnic_priv
;
1788 struct l4_kcq
*l4kcqe
= (struct l4_kcq
*) kcqe
;
1789 u8 opcode
= l4kcqe
->op_code
;
1791 struct cnic_sock
*csk
;
1793 if (opcode
== L4_KCQE_OPCODE_VALUE_OFFLOAD_PG
||
1794 opcode
== L4_KCQE_OPCODE_VALUE_UPDATE_PG
) {
1795 cnic_cm_process_offld_pg(dev
, l4kcqe
);
1799 l5_cid
= l4kcqe
->conn_id
;
1801 l5_cid
= l4kcqe
->cid
;
1802 if (l5_cid
>= MAX_CM_SK_TBL_SZ
)
1805 csk
= &cp
->csk_tbl
[l5_cid
];
1808 if (!cnic_in_use(csk
)) {
1814 case L4_KCQE_OPCODE_VALUE_CONNECT_COMPLETE
:
1815 if (l4kcqe
->status
== 0)
1816 set_bit(SK_F_OFFLD_COMPLETE
, &csk
->flags
);
1818 smp_mb__before_clear_bit();
1819 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
1820 cnic_cm_upcall(cp
, csk
, opcode
);
1823 case L4_KCQE_OPCODE_VALUE_RESET_RECEIVED
:
1824 if (test_and_clear_bit(SK_F_OFFLD_COMPLETE
, &csk
->flags
))
1825 csk
->state
= opcode
;
1827 case L4_KCQE_OPCODE_VALUE_CLOSE_COMP
:
1828 case L4_KCQE_OPCODE_VALUE_RESET_COMP
:
1829 cp
->close_conn(csk
, opcode
);
1832 case L4_KCQE_OPCODE_VALUE_CLOSE_RECEIVED
:
1833 cnic_cm_upcall(cp
, csk
, opcode
);
1839 static void cnic_cm_indicate_kcqe(void *data
, struct kcqe
*kcqe
[], u32 num
)
1841 struct cnic_dev
*dev
= data
;
1844 for (i
= 0; i
< num
; i
++)
1845 cnic_cm_process_kcqe(dev
, kcqe
[i
]);
1848 static struct cnic_ulp_ops cm_ulp_ops
= {
1849 .indicate_kcqes
= cnic_cm_indicate_kcqe
,
1852 static void cnic_cm_free_mem(struct cnic_dev
*dev
)
1854 struct cnic_local
*cp
= dev
->cnic_priv
;
1858 cnic_free_id_tbl(&cp
->csk_port_tbl
);
1861 static int cnic_cm_alloc_mem(struct cnic_dev
*dev
)
1863 struct cnic_local
*cp
= dev
->cnic_priv
;
1865 cp
->csk_tbl
= kzalloc(sizeof(struct cnic_sock
) * MAX_CM_SK_TBL_SZ
,
1870 if (cnic_init_id_tbl(&cp
->csk_port_tbl
, CNIC_LOCAL_PORT_RANGE
,
1871 CNIC_LOCAL_PORT_MIN
)) {
1872 cnic_cm_free_mem(dev
);
1878 static int cnic_ready_to_close(struct cnic_sock
*csk
, u32 opcode
)
1880 if ((opcode
== csk
->state
) ||
1881 (opcode
== L4_KCQE_OPCODE_VALUE_RESET_RECEIVED
&&
1882 csk
->state
== L4_KCQE_OPCODE_VALUE_CLOSE_COMP
)) {
1883 if (!test_and_set_bit(SK_F_CLOSING
, &csk
->flags
))
1889 static void cnic_close_bnx2_conn(struct cnic_sock
*csk
, u32 opcode
)
1891 struct cnic_dev
*dev
= csk
->dev
;
1892 struct cnic_local
*cp
= dev
->cnic_priv
;
1894 clear_bit(SK_F_CONNECT_START
, &csk
->flags
);
1895 if (cnic_ready_to_close(csk
, opcode
)) {
1896 cnic_close_conn(csk
);
1897 cnic_cm_upcall(cp
, csk
, opcode
);
1901 static void cnic_cm_stop_bnx2_hw(struct cnic_dev
*dev
)
1905 static int cnic_cm_init_bnx2_hw(struct cnic_dev
*dev
)
1909 get_random_bytes(&seed
, 4);
1910 cnic_ctx_wr(dev
, 45, 0, seed
);
1914 static int cnic_cm_open(struct cnic_dev
*dev
)
1916 struct cnic_local
*cp
= dev
->cnic_priv
;
1919 err
= cnic_cm_alloc_mem(dev
);
1923 err
= cp
->start_cm(dev
);
1928 dev
->cm_create
= cnic_cm_create
;
1929 dev
->cm_destroy
= cnic_cm_destroy
;
1930 dev
->cm_connect
= cnic_cm_connect
;
1931 dev
->cm_abort
= cnic_cm_abort
;
1932 dev
->cm_close
= cnic_cm_close
;
1933 dev
->cm_select_dev
= cnic_cm_select_dev
;
1935 cp
->ulp_handle
[CNIC_ULP_L4
] = dev
;
1936 rcu_assign_pointer(cp
->ulp_ops
[CNIC_ULP_L4
], &cm_ulp_ops
);
1940 cnic_cm_free_mem(dev
);
1944 static int cnic_cm_shutdown(struct cnic_dev
*dev
)
1946 struct cnic_local
*cp
= dev
->cnic_priv
;
1954 for (i
= 0; i
< MAX_CM_SK_TBL_SZ
; i
++) {
1955 struct cnic_sock
*csk
= &cp
->csk_tbl
[i
];
1957 clear_bit(SK_F_INUSE
, &csk
->flags
);
1958 cnic_cm_cleanup(csk
);
1960 cnic_cm_free_mem(dev
);
1965 static void cnic_init_context(struct cnic_dev
*dev
, u32 cid
)
1967 struct cnic_local
*cp
= dev
->cnic_priv
;
1971 if (CHIP_NUM(cp
) == CHIP_NUM_5709
)
1974 cid_addr
= GET_CID_ADDR(cid
);
1976 for (i
= 0; i
< CTX_SIZE
; i
+= 4)
1977 cnic_ctx_wr(dev
, cid_addr
, i
, 0);
1980 static int cnic_setup_5709_context(struct cnic_dev
*dev
, int valid
)
1982 struct cnic_local
*cp
= dev
->cnic_priv
;
1984 u32 valid_bit
= valid
? BNX2_CTX_HOST_PAGE_TBL_DATA0_VALID
: 0;
1986 if (CHIP_NUM(cp
) != CHIP_NUM_5709
)
1989 for (i
= 0; i
< cp
->ctx_blks
; i
++) {
1991 u32 idx
= cp
->ctx_arr
[i
].cid
/ cp
->cids_per_blk
;
1994 memset(cp
->ctx_arr
[i
].ctx
, 0, BCM_PAGE_SIZE
);
1996 CNIC_WR(dev
, BNX2_CTX_HOST_PAGE_TBL_DATA0
,
1997 (cp
->ctx_arr
[i
].mapping
& 0xffffffff) | valid_bit
);
1998 CNIC_WR(dev
, BNX2_CTX_HOST_PAGE_TBL_DATA1
,
1999 (u64
) cp
->ctx_arr
[i
].mapping
>> 32);
2000 CNIC_WR(dev
, BNX2_CTX_HOST_PAGE_TBL_CTRL
, idx
|
2001 BNX2_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ
);
2002 for (j
= 0; j
< 10; j
++) {
2004 val
= CNIC_RD(dev
, BNX2_CTX_HOST_PAGE_TBL_CTRL
);
2005 if (!(val
& BNX2_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ
))
2009 if (val
& BNX2_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ
) {
2017 static void cnic_free_irq(struct cnic_dev
*dev
)
2019 struct cnic_local
*cp
= dev
->cnic_priv
;
2020 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2022 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2023 cp
->disable_int_sync(dev
);
2024 tasklet_disable(&cp
->cnic_irq_task
);
2025 free_irq(ethdev
->irq_arr
[0].vector
, dev
);
2029 static int cnic_init_bnx2_irq(struct cnic_dev
*dev
)
2031 struct cnic_local
*cp
= dev
->cnic_priv
;
2032 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2034 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2036 int sblk_num
= cp
->status_blk_num
;
2037 u32 base
= ((sblk_num
- 1) * BNX2_HC_SB_CONFIG_SIZE
) +
2038 BNX2_HC_SB_CONFIG_1
;
2040 CNIC_WR(dev
, base
, BNX2_HC_SB_CONFIG_1_ONE_SHOT
);
2042 CNIC_WR(dev
, base
+ BNX2_HC_COMP_PROD_TRIP_OFF
, (2 << 16) | 8);
2043 CNIC_WR(dev
, base
+ BNX2_HC_COM_TICKS_OFF
, (64 << 16) | 220);
2044 CNIC_WR(dev
, base
+ BNX2_HC_CMD_TICKS_OFF
, (64 << 16) | 220);
2046 cp
->bnx2_status_blk
= cp
->status_blk
;
2047 cp
->last_status_idx
= cp
->bnx2_status_blk
->status_idx
;
2048 tasklet_init(&cp
->cnic_irq_task
, &cnic_service_bnx2_msix
,
2049 (unsigned long) dev
);
2050 err
= request_irq(ethdev
->irq_arr
[0].vector
, cnic_irq
, 0,
2053 tasklet_disable(&cp
->cnic_irq_task
);
2056 while (cp
->bnx2_status_blk
->status_completion_producer_index
&&
2058 CNIC_WR(dev
, BNX2_HC_COALESCE_NOW
,
2059 1 << (11 + sblk_num
));
2064 if (cp
->bnx2_status_blk
->status_completion_producer_index
) {
2070 struct status_block
*sblk
= cp
->status_blk
;
2071 u32 hc_cmd
= CNIC_RD(dev
, BNX2_HC_COMMAND
);
2074 while (sblk
->status_completion_producer_index
&& i
< 10) {
2075 CNIC_WR(dev
, BNX2_HC_COMMAND
,
2076 hc_cmd
| BNX2_HC_COMMAND_COAL_NOW_WO_INT
);
2081 if (sblk
->status_completion_producer_index
)
2088 printk(KERN_ERR PFX
"%s: " "KCQ index not resetting to 0.\n",
2093 static void cnic_enable_bnx2_int(struct cnic_dev
*dev
)
2095 struct cnic_local
*cp
= dev
->cnic_priv
;
2096 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2098 if (!(ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
))
2101 CNIC_WR(dev
, BNX2_PCICFG_INT_ACK_CMD
, cp
->int_num
|
2102 BNX2_PCICFG_INT_ACK_CMD_INDEX_VALID
| cp
->last_status_idx
);
2105 static void cnic_disable_bnx2_int_sync(struct cnic_dev
*dev
)
2107 struct cnic_local
*cp
= dev
->cnic_priv
;
2108 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2110 if (!(ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
))
2113 CNIC_WR(dev
, BNX2_PCICFG_INT_ACK_CMD
, cp
->int_num
|
2114 BNX2_PCICFG_INT_ACK_CMD_MASK_INT
);
2115 CNIC_RD(dev
, BNX2_PCICFG_INT_ACK_CMD
);
2116 synchronize_irq(ethdev
->irq_arr
[0].vector
);
2119 static void cnic_init_bnx2_tx_ring(struct cnic_dev
*dev
)
2121 struct cnic_local
*cp
= dev
->cnic_priv
;
2122 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2123 u32 cid_addr
, tx_cid
, sb_id
;
2124 u32 val
, offset0
, offset1
, offset2
, offset3
;
2128 struct status_block
*s_blk
= cp
->status_blk
;
2130 sb_id
= cp
->status_blk_num
;
2132 cnic_init_context(dev
, tx_cid
);
2133 cnic_init_context(dev
, tx_cid
+ 1);
2134 cp
->tx_cons_ptr
= &s_blk
->status_tx_quick_consumer_index2
;
2135 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2136 struct status_block_msix
*sblk
= cp
->status_blk
;
2138 tx_cid
= TX_TSS_CID
+ sb_id
- 1;
2139 cnic_init_context(dev
, tx_cid
);
2140 CNIC_WR(dev
, BNX2_TSCH_TSS_CFG
, (sb_id
<< 24) |
2142 cp
->tx_cons_ptr
= &sblk
->status_tx_quick_consumer_index
;
2144 cp
->tx_cons
= *cp
->tx_cons_ptr
;
2146 cid_addr
= GET_CID_ADDR(tx_cid
);
2147 if (CHIP_NUM(cp
) == CHIP_NUM_5709
) {
2148 u32 cid_addr2
= GET_CID_ADDR(tx_cid
+ 4) + 0x40;
2150 for (i
= 0; i
< PHY_CTX_SIZE
; i
+= 4)
2151 cnic_ctx_wr(dev
, cid_addr2
, i
, 0);
2153 offset0
= BNX2_L2CTX_TYPE_XI
;
2154 offset1
= BNX2_L2CTX_CMD_TYPE_XI
;
2155 offset2
= BNX2_L2CTX_TBDR_BHADDR_HI_XI
;
2156 offset3
= BNX2_L2CTX_TBDR_BHADDR_LO_XI
;
2158 offset0
= BNX2_L2CTX_TYPE
;
2159 offset1
= BNX2_L2CTX_CMD_TYPE
;
2160 offset2
= BNX2_L2CTX_TBDR_BHADDR_HI
;
2161 offset3
= BNX2_L2CTX_TBDR_BHADDR_LO
;
2163 val
= BNX2_L2CTX_TYPE_TYPE_L2
| BNX2_L2CTX_TYPE_SIZE_L2
;
2164 cnic_ctx_wr(dev
, cid_addr
, offset0
, val
);
2166 val
= BNX2_L2CTX_CMD_TYPE_TYPE_L2
| (8 << 16);
2167 cnic_ctx_wr(dev
, cid_addr
, offset1
, val
);
2169 txbd
= (struct tx_bd
*) cp
->l2_ring
;
2171 buf_map
= cp
->l2_buf_map
;
2172 for (i
= 0; i
< MAX_TX_DESC_CNT
; i
++, txbd
++) {
2173 txbd
->tx_bd_haddr_hi
= (u64
) buf_map
>> 32;
2174 txbd
->tx_bd_haddr_lo
= (u64
) buf_map
& 0xffffffff;
2176 val
= (u64
) cp
->l2_ring_map
>> 32;
2177 cnic_ctx_wr(dev
, cid_addr
, offset2
, val
);
2178 txbd
->tx_bd_haddr_hi
= val
;
2180 val
= (u64
) cp
->l2_ring_map
& 0xffffffff;
2181 cnic_ctx_wr(dev
, cid_addr
, offset3
, val
);
2182 txbd
->tx_bd_haddr_lo
= val
;
2185 static void cnic_init_bnx2_rx_ring(struct cnic_dev
*dev
)
2187 struct cnic_local
*cp
= dev
->cnic_priv
;
2188 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2189 u32 cid_addr
, sb_id
, val
, coal_reg
, coal_val
;
2192 struct status_block
*s_blk
= cp
->status_blk
;
2194 sb_id
= cp
->status_blk_num
;
2195 cnic_init_context(dev
, 2);
2196 cp
->rx_cons_ptr
= &s_blk
->status_rx_quick_consumer_index2
;
2197 coal_reg
= BNX2_HC_COMMAND
;
2198 coal_val
= CNIC_RD(dev
, coal_reg
);
2199 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2200 struct status_block_msix
*sblk
= cp
->status_blk
;
2202 cp
->rx_cons_ptr
= &sblk
->status_rx_quick_consumer_index
;
2203 coal_reg
= BNX2_HC_COALESCE_NOW
;
2204 coal_val
= 1 << (11 + sb_id
);
2207 while (!(*cp
->rx_cons_ptr
!= 0) && i
< 10) {
2208 CNIC_WR(dev
, coal_reg
, coal_val
);
2213 cp
->rx_cons
= *cp
->rx_cons_ptr
;
2215 cid_addr
= GET_CID_ADDR(2);
2216 val
= BNX2_L2CTX_CTX_TYPE_CTX_BD_CHN_TYPE_VALUE
|
2217 BNX2_L2CTX_CTX_TYPE_SIZE_L2
| (0x02 << 8);
2218 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_CTX_TYPE
, val
);
2221 val
= 2 << BNX2_L2CTX_STATUSB_NUM_SHIFT
;
2223 val
= BNX2_L2CTX_STATUSB_NUM(sb_id
);
2224 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_HOST_BDIDX
, val
);
2226 rxbd
= (struct rx_bd
*) (cp
->l2_ring
+ BCM_PAGE_SIZE
);
2227 for (i
= 0; i
< MAX_RX_DESC_CNT
; i
++, rxbd
++) {
2229 int n
= (i
% cp
->l2_rx_ring_size
) + 1;
2231 buf_map
= cp
->l2_buf_map
+ (n
* cp
->l2_single_buf_size
);
2232 rxbd
->rx_bd_len
= cp
->l2_single_buf_size
;
2233 rxbd
->rx_bd_flags
= RX_BD_FLAGS_START
| RX_BD_FLAGS_END
;
2234 rxbd
->rx_bd_haddr_hi
= (u64
) buf_map
>> 32;
2235 rxbd
->rx_bd_haddr_lo
= (u64
) buf_map
& 0xffffffff;
2237 val
= (u64
) (cp
->l2_ring_map
+ BCM_PAGE_SIZE
) >> 32;
2238 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_NX_BDHADDR_HI
, val
);
2239 rxbd
->rx_bd_haddr_hi
= val
;
2241 val
= (u64
) (cp
->l2_ring_map
+ BCM_PAGE_SIZE
) & 0xffffffff;
2242 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_NX_BDHADDR_LO
, val
);
2243 rxbd
->rx_bd_haddr_lo
= val
;
2245 val
= cnic_reg_rd_ind(dev
, BNX2_RXP_SCRATCH_RXP_FLOOD
);
2246 cnic_reg_wr_ind(dev
, BNX2_RXP_SCRATCH_RXP_FLOOD
, val
| (1 << 2));
2249 static void cnic_shutdown_bnx2_rx_ring(struct cnic_dev
*dev
)
2251 struct kwqe
*wqes
[1], l2kwqe
;
2253 memset(&l2kwqe
, 0, sizeof(l2kwqe
));
2255 l2kwqe
.kwqe_op_flag
= (L2_LAYER_CODE
<< KWQE_FLAGS_LAYER_SHIFT
) |
2256 (L2_KWQE_OPCODE_VALUE_FLUSH
<<
2257 KWQE_OPCODE_SHIFT
) | 2;
2258 dev
->submit_kwqes(dev
, wqes
, 1);
2261 static void cnic_set_bnx2_mac(struct cnic_dev
*dev
)
2263 struct cnic_local
*cp
= dev
->cnic_priv
;
2266 val
= cp
->func
<< 2;
2268 cp
->shmem_base
= cnic_reg_rd_ind(dev
, BNX2_SHM_HDR_ADDR_0
+ val
);
2270 val
= cnic_reg_rd_ind(dev
, cp
->shmem_base
+
2271 BNX2_PORT_HW_CFG_ISCSI_MAC_UPPER
);
2272 dev
->mac_addr
[0] = (u8
) (val
>> 8);
2273 dev
->mac_addr
[1] = (u8
) val
;
2275 CNIC_WR(dev
, BNX2_EMAC_MAC_MATCH4
, val
);
2277 val
= cnic_reg_rd_ind(dev
, cp
->shmem_base
+
2278 BNX2_PORT_HW_CFG_ISCSI_MAC_LOWER
);
2279 dev
->mac_addr
[2] = (u8
) (val
>> 24);
2280 dev
->mac_addr
[3] = (u8
) (val
>> 16);
2281 dev
->mac_addr
[4] = (u8
) (val
>> 8);
2282 dev
->mac_addr
[5] = (u8
) val
;
2284 CNIC_WR(dev
, BNX2_EMAC_MAC_MATCH5
, val
);
2286 val
= 4 | BNX2_RPM_SORT_USER2_BC_EN
;
2287 if (CHIP_NUM(cp
) != CHIP_NUM_5709
)
2288 val
|= BNX2_RPM_SORT_USER2_PROM_VLAN
;
2290 CNIC_WR(dev
, BNX2_RPM_SORT_USER2
, 0x0);
2291 CNIC_WR(dev
, BNX2_RPM_SORT_USER2
, val
);
2292 CNIC_WR(dev
, BNX2_RPM_SORT_USER2
, val
| BNX2_RPM_SORT_USER2_ENA
);
2295 static int cnic_start_bnx2_hw(struct cnic_dev
*dev
)
2297 struct cnic_local
*cp
= dev
->cnic_priv
;
2298 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2299 struct status_block
*sblk
= cp
->status_blk
;
2303 cnic_set_bnx2_mac(dev
);
2305 val
= CNIC_RD(dev
, BNX2_MQ_CONFIG
);
2306 val
&= ~BNX2_MQ_CONFIG_KNL_BYP_BLK_SIZE
;
2307 if (BCM_PAGE_BITS
> 12)
2308 val
|= (12 - 8) << 4;
2310 val
|= (BCM_PAGE_BITS
- 8) << 4;
2312 CNIC_WR(dev
, BNX2_MQ_CONFIG
, val
);
2314 CNIC_WR(dev
, BNX2_HC_COMP_PROD_TRIP
, (2 << 16) | 8);
2315 CNIC_WR(dev
, BNX2_HC_COM_TICKS
, (64 << 16) | 220);
2316 CNIC_WR(dev
, BNX2_HC_CMD_TICKS
, (64 << 16) | 220);
2318 err
= cnic_setup_5709_context(dev
, 1);
2322 cnic_init_context(dev
, KWQ_CID
);
2323 cnic_init_context(dev
, KCQ_CID
);
2325 cp
->kwq_cid_addr
= GET_CID_ADDR(KWQ_CID
);
2326 cp
->kwq_io_addr
= MB_GET_CID_ADDR(KWQ_CID
) + L5_KRNLQ_HOST_QIDX
;
2328 cp
->max_kwq_idx
= MAX_KWQ_IDX
;
2329 cp
->kwq_prod_idx
= 0;
2330 cp
->kwq_con_idx
= 0;
2331 cp
->cnic_local_flags
|= CNIC_LCL_FL_KWQ_INIT
;
2333 if (CHIP_NUM(cp
) == CHIP_NUM_5706
|| CHIP_NUM(cp
) == CHIP_NUM_5708
)
2334 cp
->kwq_con_idx_ptr
= &sblk
->status_rx_quick_consumer_index15
;
2336 cp
->kwq_con_idx_ptr
= &sblk
->status_cmd_consumer_index
;
2338 /* Initialize the kernel work queue context. */
2339 val
= KRNLQ_TYPE_TYPE_KRNLQ
| KRNLQ_SIZE_TYPE_SIZE
|
2340 (BCM_PAGE_BITS
- 8) | KRNLQ_FLAGS_QE_SELF_SEQ
;
2341 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_TYPE
, val
);
2343 val
= (BCM_PAGE_SIZE
/ sizeof(struct kwqe
) - 1) << 16;
2344 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_QE_SELF_SEQ_MAX
, val
);
2346 val
= ((BCM_PAGE_SIZE
/ sizeof(struct kwqe
)) << 16) | KWQ_PAGE_CNT
;
2347 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_PGTBL_NPAGES
, val
);
2349 val
= (u32
) ((u64
) cp
->kwq_info
.pgtbl_map
>> 32);
2350 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_HI
, val
);
2352 val
= (u32
) cp
->kwq_info
.pgtbl_map
;
2353 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_LO
, val
);
2355 cp
->kcq_cid_addr
= GET_CID_ADDR(KCQ_CID
);
2356 cp
->kcq_io_addr
= MB_GET_CID_ADDR(KCQ_CID
) + L5_KRNLQ_HOST_QIDX
;
2358 cp
->kcq_prod_idx
= 0;
2360 /* Initialize the kernel complete queue context. */
2361 val
= KRNLQ_TYPE_TYPE_KRNLQ
| KRNLQ_SIZE_TYPE_SIZE
|
2362 (BCM_PAGE_BITS
- 8) | KRNLQ_FLAGS_QE_SELF_SEQ
;
2363 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_TYPE
, val
);
2365 val
= (BCM_PAGE_SIZE
/ sizeof(struct kcqe
) - 1) << 16;
2366 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_QE_SELF_SEQ_MAX
, val
);
2368 val
= ((BCM_PAGE_SIZE
/ sizeof(struct kcqe
)) << 16) | KCQ_PAGE_CNT
;
2369 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_PGTBL_NPAGES
, val
);
2371 val
= (u32
) ((u64
) cp
->kcq_info
.pgtbl_map
>> 32);
2372 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_HI
, val
);
2374 val
= (u32
) cp
->kcq_info
.pgtbl_map
;
2375 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_LO
, val
);
2378 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2379 u32 sb_id
= cp
->status_blk_num
;
2380 u32 sb
= BNX2_L2CTX_STATUSB_NUM(sb_id
);
2382 cp
->int_num
= sb_id
<< BNX2_PCICFG_INT_ACK_CMD_INT_NUM_SHIFT
;
2383 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_HOST_QIDX
, sb
);
2384 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_HOST_QIDX
, sb
);
2387 /* Enable Commnad Scheduler notification when we write to the
2388 * host producer index of the kernel contexts. */
2389 CNIC_WR(dev
, BNX2_MQ_KNL_CMD_MASK1
, 2);
2391 /* Enable Command Scheduler notification when we write to either
2392 * the Send Queue or Receive Queue producer indexes of the kernel
2393 * bypass contexts. */
2394 CNIC_WR(dev
, BNX2_MQ_KNL_BYP_CMD_MASK1
, 7);
2395 CNIC_WR(dev
, BNX2_MQ_KNL_BYP_WRITE_MASK1
, 7);
2397 /* Notify COM when the driver post an application buffer. */
2398 CNIC_WR(dev
, BNX2_MQ_KNL_RX_V2P_MASK2
, 0x2000);
2400 /* Set the CP and COM doorbells. These two processors polls the
2401 * doorbell for a non zero value before running. This must be done
2402 * after setting up the kernel queue contexts. */
2403 cnic_reg_wr_ind(dev
, BNX2_CP_SCRATCH
+ 0x20, 1);
2404 cnic_reg_wr_ind(dev
, BNX2_COM_SCRATCH
+ 0x20, 1);
2406 cnic_init_bnx2_tx_ring(dev
);
2407 cnic_init_bnx2_rx_ring(dev
);
2409 err
= cnic_init_bnx2_irq(dev
);
2411 printk(KERN_ERR PFX
"%s: cnic_init_irq failed\n",
2413 cnic_reg_wr_ind(dev
, BNX2_CP_SCRATCH
+ 0x20, 0);
2414 cnic_reg_wr_ind(dev
, BNX2_COM_SCRATCH
+ 0x20, 0);
2421 static int cnic_start_hw(struct cnic_dev
*dev
)
2423 struct cnic_local
*cp
= dev
->cnic_priv
;
2424 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2427 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
))
2430 err
= ethdev
->drv_register_cnic(dev
->netdev
, cp
->cnic_ops
, dev
);
2432 printk(KERN_ERR PFX
"%s: register_cnic failed\n",
2437 dev
->regview
= ethdev
->io_base
;
2438 cp
->chip_id
= ethdev
->chip_id
;
2439 pci_dev_get(dev
->pcidev
);
2440 cp
->func
= PCI_FUNC(dev
->pcidev
->devfn
);
2441 cp
->status_blk
= ethdev
->irq_arr
[0].status_blk
;
2442 cp
->status_blk_num
= ethdev
->irq_arr
[0].status_blk_num
;
2444 err
= cp
->alloc_resc(dev
);
2446 printk(KERN_ERR PFX
"%s: allocate resource failure\n",
2451 err
= cp
->start_hw(dev
);
2455 err
= cnic_cm_open(dev
);
2459 set_bit(CNIC_F_CNIC_UP
, &dev
->flags
);
2461 cp
->enable_int(dev
);
2466 ethdev
->drv_unregister_cnic(dev
->netdev
);
2468 pci_dev_put(dev
->pcidev
);
2473 static void cnic_stop_bnx2_hw(struct cnic_dev
*dev
)
2475 struct cnic_local
*cp
= dev
->cnic_priv
;
2476 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2478 cnic_disable_bnx2_int_sync(dev
);
2480 cnic_reg_wr_ind(dev
, BNX2_CP_SCRATCH
+ 0x20, 0);
2481 cnic_reg_wr_ind(dev
, BNX2_COM_SCRATCH
+ 0x20, 0);
2483 cnic_init_context(dev
, KWQ_CID
);
2484 cnic_init_context(dev
, KCQ_CID
);
2486 cnic_setup_5709_context(dev
, 0);
2489 ethdev
->drv_unregister_cnic(dev
->netdev
);
2491 cnic_free_resc(dev
);
2494 static void cnic_stop_hw(struct cnic_dev
*dev
)
2496 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)) {
2497 struct cnic_local
*cp
= dev
->cnic_priv
;
2499 clear_bit(CNIC_F_CNIC_UP
, &dev
->flags
);
2500 rcu_assign_pointer(cp
->ulp_ops
[CNIC_ULP_L4
], NULL
);
2502 cnic_cm_shutdown(dev
);
2504 pci_dev_put(dev
->pcidev
);
2508 static void cnic_free_dev(struct cnic_dev
*dev
)
2512 while ((atomic_read(&dev
->ref_count
) != 0) && i
< 10) {
2516 if (atomic_read(&dev
->ref_count
) != 0)
2517 printk(KERN_ERR PFX
"%s: Failed waiting for ref count to go"
2518 " to zero.\n", dev
->netdev
->name
);
2520 printk(KERN_INFO PFX
"Removed CNIC device: %s\n", dev
->netdev
->name
);
2521 dev_put(dev
->netdev
);
2525 static struct cnic_dev
*cnic_alloc_dev(struct net_device
*dev
,
2526 struct pci_dev
*pdev
)
2528 struct cnic_dev
*cdev
;
2529 struct cnic_local
*cp
;
2532 alloc_size
= sizeof(struct cnic_dev
) + sizeof(struct cnic_local
);
2534 cdev
= kzalloc(alloc_size
, GFP_KERNEL
);
2536 printk(KERN_ERR PFX
"%s: allocate dev struct failure\n",
2542 cdev
->cnic_priv
= (char *)cdev
+ sizeof(struct cnic_dev
);
2543 cdev
->register_device
= cnic_register_device
;
2544 cdev
->unregister_device
= cnic_unregister_device
;
2545 cdev
->iscsi_nl_msg_recv
= cnic_iscsi_nl_msg_recv
;
2547 cp
= cdev
->cnic_priv
;
2550 cp
->l2_single_buf_size
= 0x400;
2551 cp
->l2_rx_ring_size
= 3;
2553 spin_lock_init(&cp
->cnic_ulp_lock
);
2555 printk(KERN_INFO PFX
"Added CNIC device: %s\n", dev
->name
);
2560 static struct cnic_dev
*init_bnx2_cnic(struct net_device
*dev
)
2562 struct pci_dev
*pdev
;
2563 struct cnic_dev
*cdev
;
2564 struct cnic_local
*cp
;
2565 struct cnic_eth_dev
*ethdev
= NULL
;
2566 struct cnic_eth_dev
*(*probe
)(struct net_device
*) = NULL
;
2568 probe
= symbol_get(bnx2_cnic_probe
);
2570 ethdev
= (*probe
)(dev
);
2571 symbol_put_addr(probe
);
2576 pdev
= ethdev
->pdev
;
2582 if (pdev
->device
== PCI_DEVICE_ID_NX2_5709
||
2583 pdev
->device
== PCI_DEVICE_ID_NX2_5709S
) {
2586 pci_read_config_byte(pdev
, PCI_REVISION_ID
, &rev
);
2594 cdev
= cnic_alloc_dev(dev
, pdev
);
2598 set_bit(CNIC_F_BNX2_CLASS
, &cdev
->flags
);
2599 cdev
->submit_kwqes
= cnic_submit_bnx2_kwqes
;
2601 cp
= cdev
->cnic_priv
;
2602 cp
->ethdev
= ethdev
;
2603 cdev
->pcidev
= pdev
;
2605 cp
->cnic_ops
= &cnic_bnx2_ops
;
2606 cp
->start_hw
= cnic_start_bnx2_hw
;
2607 cp
->stop_hw
= cnic_stop_bnx2_hw
;
2608 cp
->setup_pgtbl
= cnic_setup_page_tbl
;
2609 cp
->alloc_resc
= cnic_alloc_bnx2_resc
;
2610 cp
->free_resc
= cnic_free_resc
;
2611 cp
->start_cm
= cnic_cm_init_bnx2_hw
;
2612 cp
->stop_cm
= cnic_cm_stop_bnx2_hw
;
2613 cp
->enable_int
= cnic_enable_bnx2_int
;
2614 cp
->disable_int_sync
= cnic_disable_bnx2_int_sync
;
2615 cp
->close_conn
= cnic_close_bnx2_conn
;
2616 cp
->next_idx
= cnic_bnx2_next_idx
;
2617 cp
->hw_idx
= cnic_bnx2_hw_idx
;
2625 static struct cnic_dev
*is_cnic_dev(struct net_device
*dev
)
2627 struct ethtool_drvinfo drvinfo
;
2628 struct cnic_dev
*cdev
= NULL
;
2630 if (dev
->ethtool_ops
&& dev
->ethtool_ops
->get_drvinfo
) {
2631 memset(&drvinfo
, 0, sizeof(drvinfo
));
2632 dev
->ethtool_ops
->get_drvinfo(dev
, &drvinfo
);
2634 if (!strcmp(drvinfo
.driver
, "bnx2"))
2635 cdev
= init_bnx2_cnic(dev
);
2637 write_lock(&cnic_dev_lock
);
2638 list_add(&cdev
->list
, &cnic_dev_list
);
2639 write_unlock(&cnic_dev_lock
);
2646 * netdev event handler
2648 static int cnic_netdev_event(struct notifier_block
*this, unsigned long event
,
2651 struct net_device
*netdev
= ptr
;
2652 struct cnic_dev
*dev
;
2656 dev
= cnic_from_netdev(netdev
);
2658 if (!dev
&& (event
== NETDEV_REGISTER
|| event
== NETDEV_UP
)) {
2659 /* Check for the hot-plug device */
2660 dev
= is_cnic_dev(netdev
);
2667 struct cnic_local
*cp
= dev
->cnic_priv
;
2671 else if (event
== NETDEV_UNREGISTER
)
2673 else if (event
== NETDEV_UP
) {
2674 mutex_lock(&cnic_lock
);
2675 if (!cnic_start_hw(dev
))
2676 cnic_ulp_start(dev
);
2677 mutex_unlock(&cnic_lock
);
2681 for (if_type
= 0; if_type
< MAX_CNIC_ULP_TYPE
; if_type
++) {
2682 struct cnic_ulp_ops
*ulp_ops
;
2685 ulp_ops
= rcu_dereference(cp
->ulp_ops
[if_type
]);
2686 if (!ulp_ops
|| !ulp_ops
->indicate_netevent
)
2689 ctx
= cp
->ulp_handle
[if_type
];
2691 ulp_ops
->indicate_netevent(ctx
, event
);
2695 if (event
== NETDEV_GOING_DOWN
) {
2696 mutex_lock(&cnic_lock
);
2699 mutex_unlock(&cnic_lock
);
2700 } else if (event
== NETDEV_UNREGISTER
) {
2701 write_lock(&cnic_dev_lock
);
2702 list_del_init(&dev
->list
);
2703 write_unlock(&cnic_dev_lock
);
2715 static struct notifier_block cnic_netdev_notifier
= {
2716 .notifier_call
= cnic_netdev_event
2719 static void cnic_release(void)
2721 struct cnic_dev
*dev
;
2723 while (!list_empty(&cnic_dev_list
)) {
2724 dev
= list_entry(cnic_dev_list
.next
, struct cnic_dev
, list
);
2725 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)) {
2731 list_del_init(&dev
->list
);
2736 static int __init
cnic_init(void)
2740 printk(KERN_INFO
"%s", version
);
2742 rc
= register_netdevice_notifier(&cnic_netdev_notifier
);
2751 static void __exit
cnic_exit(void)
2753 unregister_netdevice_notifier(&cnic_netdev_notifier
);
2758 module_init(cnic_init
);
2759 module_exit(cnic_exit
);