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_bnx2_resc(struct cnic_dev
*dev
)
767 struct cnic_local
*cp
= dev
->cnic_priv
;
768 struct uio_info
*uinfo
;
771 ret
= cnic_alloc_dma(dev
, &cp
->kwq_info
, KWQ_PAGE_CNT
, 1);
774 cp
->kwq
= (struct kwqe
**) cp
->kwq_info
.pg_arr
;
776 ret
= cnic_alloc_dma(dev
, &cp
->kcq_info
, KCQ_PAGE_CNT
, 1);
779 cp
->kcq
= (struct kcqe
**) cp
->kcq_info
.pg_arr
;
781 ret
= cnic_alloc_context(dev
);
785 ret
= cnic_alloc_l2_rings(dev
, 2);
789 uinfo
= kzalloc(sizeof(*uinfo
), GFP_ATOMIC
);
793 uinfo
->mem
[0].addr
= dev
->netdev
->base_addr
;
794 uinfo
->mem
[0].internal_addr
= dev
->regview
;
795 uinfo
->mem
[0].size
= dev
->netdev
->mem_end
- dev
->netdev
->mem_start
;
796 uinfo
->mem
[0].memtype
= UIO_MEM_PHYS
;
798 uinfo
->mem
[1].addr
= (unsigned long) cp
->status_blk
& PAGE_MASK
;
799 if (cp
->ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
)
800 uinfo
->mem
[1].size
= BNX2_SBLK_MSIX_ALIGN_SIZE
* 9;
802 uinfo
->mem
[1].size
= BNX2_SBLK_MSIX_ALIGN_SIZE
;
803 uinfo
->mem
[1].memtype
= UIO_MEM_LOGICAL
;
805 uinfo
->mem
[2].addr
= (unsigned long) cp
->l2_ring
;
806 uinfo
->mem
[2].size
= cp
->l2_ring_size
;
807 uinfo
->mem
[2].memtype
= UIO_MEM_LOGICAL
;
809 uinfo
->mem
[3].addr
= (unsigned long) cp
->l2_buf
;
810 uinfo
->mem
[3].size
= cp
->l2_buf_size
;
811 uinfo
->mem
[3].memtype
= UIO_MEM_LOGICAL
;
813 uinfo
->name
= "bnx2_cnic";
814 uinfo
->version
= CNIC_MODULE_VERSION
;
815 uinfo
->irq
= UIO_IRQ_CUSTOM
;
817 uinfo
->open
= cnic_uio_open
;
818 uinfo
->release
= cnic_uio_close
;
822 ret
= uio_register_device(&dev
->pcidev
->dev
, uinfo
);
828 cp
->cnic_uinfo
= uinfo
;
837 static inline u32
cnic_kwq_avail(struct cnic_local
*cp
)
839 return cp
->max_kwq_idx
-
840 ((cp
->kwq_prod_idx
- cp
->kwq_con_idx
) & cp
->max_kwq_idx
);
843 static int cnic_submit_bnx2_kwqes(struct cnic_dev
*dev
, struct kwqe
*wqes
[],
846 struct cnic_local
*cp
= dev
->cnic_priv
;
847 struct kwqe
*prod_qe
;
848 u16 prod
, sw_prod
, i
;
850 if (!test_bit(CNIC_F_CNIC_UP
, &dev
->flags
))
851 return -EAGAIN
; /* bnx2 is down */
853 spin_lock_bh(&cp
->cnic_ulp_lock
);
854 if (num_wqes
> cnic_kwq_avail(cp
) &&
855 !(cp
->cnic_local_flags
& CNIC_LCL_FL_KWQ_INIT
)) {
856 spin_unlock_bh(&cp
->cnic_ulp_lock
);
860 cp
->cnic_local_flags
&= ~CNIC_LCL_FL_KWQ_INIT
;
862 prod
= cp
->kwq_prod_idx
;
863 sw_prod
= prod
& MAX_KWQ_IDX
;
864 for (i
= 0; i
< num_wqes
; i
++) {
865 prod_qe
= &cp
->kwq
[KWQ_PG(sw_prod
)][KWQ_IDX(sw_prod
)];
866 memcpy(prod_qe
, wqes
[i
], sizeof(struct kwqe
));
868 sw_prod
= prod
& MAX_KWQ_IDX
;
870 cp
->kwq_prod_idx
= prod
;
872 CNIC_WR16(dev
, cp
->kwq_io_addr
, cp
->kwq_prod_idx
);
874 spin_unlock_bh(&cp
->cnic_ulp_lock
);
878 static void service_kcqes(struct cnic_dev
*dev
, int num_cqes
)
880 struct cnic_local
*cp
= dev
->cnic_priv
;
886 struct cnic_ulp_ops
*ulp_ops
;
888 u32 kcqe_op_flag
= cp
->completed_kcq
[i
]->kcqe_op_flag
;
889 u32 kcqe_layer
= kcqe_op_flag
& KCQE_FLAGS_LAYER_MASK
;
891 if (unlikely(kcqe_op_flag
& KCQE_RAMROD_COMPLETION
))
892 cnic_kwq_completion(dev
, 1);
894 while (j
< num_cqes
) {
895 u32 next_op
= cp
->completed_kcq
[i
+ j
]->kcqe_op_flag
;
897 if ((next_op
& KCQE_FLAGS_LAYER_MASK
) != kcqe_layer
)
900 if (unlikely(next_op
& KCQE_RAMROD_COMPLETION
))
901 cnic_kwq_completion(dev
, 1);
905 if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L5_RDMA
)
906 ulp_type
= CNIC_ULP_RDMA
;
907 else if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L5_ISCSI
)
908 ulp_type
= CNIC_ULP_ISCSI
;
909 else if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L4
)
910 ulp_type
= CNIC_ULP_L4
;
911 else if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L2
)
914 printk(KERN_ERR PFX
"%s: Unknown type of KCQE(0x%x)\n",
915 dev
->netdev
->name
, kcqe_op_flag
);
920 ulp_ops
= rcu_dereference(cp
->ulp_ops
[ulp_type
]);
921 if (likely(ulp_ops
)) {
922 ulp_ops
->indicate_kcqes(cp
->ulp_handle
[ulp_type
],
923 cp
->completed_kcq
+ i
, j
);
934 static u16
cnic_bnx2_next_idx(u16 idx
)
939 static u16
cnic_bnx2_hw_idx(u16 idx
)
944 static int cnic_get_kcqes(struct cnic_dev
*dev
, u16 hw_prod
, u16
*sw_prod
)
946 struct cnic_local
*cp
= dev
->cnic_priv
;
949 int kcqe_cnt
= 0, last_cnt
= 0;
951 i
= ri
= last
= *sw_prod
;
954 while ((i
!= hw_prod
) && (kcqe_cnt
< MAX_COMPLETED_KCQE
)) {
955 kcqe
= &cp
->kcq
[KCQ_PG(ri
)][KCQ_IDX(ri
)];
956 cp
->completed_kcq
[kcqe_cnt
++] = kcqe
;
958 ri
= i
& MAX_KCQ_IDX
;
959 if (likely(!(kcqe
->kcqe_op_flag
& KCQE_FLAGS_NEXT
))) {
969 static void cnic_chk_bnx2_pkt_rings(struct cnic_local
*cp
)
971 u16 rx_cons
= *cp
->rx_cons_ptr
;
972 u16 tx_cons
= *cp
->tx_cons_ptr
;
974 if (cp
->tx_cons
!= tx_cons
|| cp
->rx_cons
!= rx_cons
) {
975 cp
->tx_cons
= tx_cons
;
976 cp
->rx_cons
= rx_cons
;
977 uio_event_notify(cp
->cnic_uinfo
);
981 static int cnic_service_bnx2(void *data
, void *status_blk
)
983 struct cnic_dev
*dev
= data
;
984 struct status_block
*sblk
= status_blk
;
985 struct cnic_local
*cp
= dev
->cnic_priv
;
986 u32 status_idx
= sblk
->status_idx
;
987 u16 hw_prod
, sw_prod
;
990 if (unlikely(!test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)))
993 cp
->kwq_con_idx
= *cp
->kwq_con_idx_ptr
;
995 hw_prod
= sblk
->status_completion_producer_index
;
996 sw_prod
= cp
->kcq_prod_idx
;
997 while (sw_prod
!= hw_prod
) {
998 kcqe_cnt
= cnic_get_kcqes(dev
, hw_prod
, &sw_prod
);
1002 service_kcqes(dev
, kcqe_cnt
);
1004 /* Tell compiler that status_blk fields can change. */
1006 if (status_idx
!= sblk
->status_idx
) {
1007 status_idx
= sblk
->status_idx
;
1008 cp
->kwq_con_idx
= *cp
->kwq_con_idx_ptr
;
1009 hw_prod
= sblk
->status_completion_producer_index
;
1015 CNIC_WR16(dev
, cp
->kcq_io_addr
, sw_prod
);
1017 cp
->kcq_prod_idx
= sw_prod
;
1019 cnic_chk_bnx2_pkt_rings(cp
);
1023 static void cnic_service_bnx2_msix(unsigned long data
)
1025 struct cnic_dev
*dev
= (struct cnic_dev
*) data
;
1026 struct cnic_local
*cp
= dev
->cnic_priv
;
1027 struct status_block_msix
*status_blk
= cp
->bnx2_status_blk
;
1028 u32 status_idx
= status_blk
->status_idx
;
1029 u16 hw_prod
, sw_prod
;
1032 cp
->kwq_con_idx
= status_blk
->status_cmd_consumer_index
;
1034 hw_prod
= status_blk
->status_completion_producer_index
;
1035 sw_prod
= cp
->kcq_prod_idx
;
1036 while (sw_prod
!= hw_prod
) {
1037 kcqe_cnt
= cnic_get_kcqes(dev
, hw_prod
, &sw_prod
);
1041 service_kcqes(dev
, kcqe_cnt
);
1043 /* Tell compiler that status_blk fields can change. */
1045 if (status_idx
!= status_blk
->status_idx
) {
1046 status_idx
= status_blk
->status_idx
;
1047 cp
->kwq_con_idx
= status_blk
->status_cmd_consumer_index
;
1048 hw_prod
= status_blk
->status_completion_producer_index
;
1054 CNIC_WR16(dev
, cp
->kcq_io_addr
, sw_prod
);
1055 cp
->kcq_prod_idx
= sw_prod
;
1057 cnic_chk_bnx2_pkt_rings(cp
);
1059 cp
->last_status_idx
= status_idx
;
1060 CNIC_WR(dev
, BNX2_PCICFG_INT_ACK_CMD
, cp
->int_num
|
1061 BNX2_PCICFG_INT_ACK_CMD_INDEX_VALID
| cp
->last_status_idx
);
1064 static irqreturn_t
cnic_irq(int irq
, void *dev_instance
)
1066 struct cnic_dev
*dev
= dev_instance
;
1067 struct cnic_local
*cp
= dev
->cnic_priv
;
1068 u16 prod
= cp
->kcq_prod_idx
& MAX_KCQ_IDX
;
1073 prefetch(cp
->status_blk
);
1074 prefetch(&cp
->kcq
[KCQ_PG(prod
)][KCQ_IDX(prod
)]);
1076 if (likely(test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)))
1077 tasklet_schedule(&cp
->cnic_irq_task
);
1082 static void cnic_ulp_stop(struct cnic_dev
*dev
)
1084 struct cnic_local
*cp
= dev
->cnic_priv
;
1088 cnic_send_nlmsg(cp
, ISCSI_KEVENT_IF_DOWN
, NULL
);
1091 for (if_type
= 0; if_type
< MAX_CNIC_ULP_TYPE
; if_type
++) {
1092 struct cnic_ulp_ops
*ulp_ops
;
1094 ulp_ops
= rcu_dereference(cp
->ulp_ops
[if_type
]);
1098 if (test_and_clear_bit(ULP_F_START
, &cp
->ulp_flags
[if_type
]))
1099 ulp_ops
->cnic_stop(cp
->ulp_handle
[if_type
]);
1104 static void cnic_ulp_start(struct cnic_dev
*dev
)
1106 struct cnic_local
*cp
= dev
->cnic_priv
;
1110 for (if_type
= 0; if_type
< MAX_CNIC_ULP_TYPE
; if_type
++) {
1111 struct cnic_ulp_ops
*ulp_ops
;
1113 ulp_ops
= rcu_dereference(cp
->ulp_ops
[if_type
]);
1114 if (!ulp_ops
|| !ulp_ops
->cnic_start
)
1117 if (!test_and_set_bit(ULP_F_START
, &cp
->ulp_flags
[if_type
]))
1118 ulp_ops
->cnic_start(cp
->ulp_handle
[if_type
]);
1123 static int cnic_ctl(void *data
, struct cnic_ctl_info
*info
)
1125 struct cnic_dev
*dev
= data
;
1127 switch (info
->cmd
) {
1128 case CNIC_CTL_STOP_CMD
:
1130 mutex_lock(&cnic_lock
);
1135 mutex_unlock(&cnic_lock
);
1138 case CNIC_CTL_START_CMD
:
1140 mutex_lock(&cnic_lock
);
1142 if (!cnic_start_hw(dev
))
1143 cnic_ulp_start(dev
);
1145 mutex_unlock(&cnic_lock
);
1154 static void cnic_ulp_init(struct cnic_dev
*dev
)
1157 struct cnic_local
*cp
= dev
->cnic_priv
;
1160 for (i
= 0; i
< MAX_CNIC_ULP_TYPE_EXT
; i
++) {
1161 struct cnic_ulp_ops
*ulp_ops
;
1163 ulp_ops
= rcu_dereference(cnic_ulp_tbl
[i
]);
1164 if (!ulp_ops
|| !ulp_ops
->cnic_init
)
1167 if (!test_and_set_bit(ULP_F_INIT
, &cp
->ulp_flags
[i
]))
1168 ulp_ops
->cnic_init(dev
);
1174 static void cnic_ulp_exit(struct cnic_dev
*dev
)
1177 struct cnic_local
*cp
= dev
->cnic_priv
;
1180 for (i
= 0; i
< MAX_CNIC_ULP_TYPE_EXT
; i
++) {
1181 struct cnic_ulp_ops
*ulp_ops
;
1183 ulp_ops
= rcu_dereference(cnic_ulp_tbl
[i
]);
1184 if (!ulp_ops
|| !ulp_ops
->cnic_exit
)
1187 if (test_and_clear_bit(ULP_F_INIT
, &cp
->ulp_flags
[i
]))
1188 ulp_ops
->cnic_exit(dev
);
1194 static int cnic_cm_offload_pg(struct cnic_sock
*csk
)
1196 struct cnic_dev
*dev
= csk
->dev
;
1197 struct l4_kwq_offload_pg
*l4kwqe
;
1198 struct kwqe
*wqes
[1];
1200 l4kwqe
= (struct l4_kwq_offload_pg
*) &csk
->kwqe1
;
1201 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1202 wqes
[0] = (struct kwqe
*) l4kwqe
;
1204 l4kwqe
->op_code
= L4_KWQE_OPCODE_VALUE_OFFLOAD_PG
;
1206 L4_LAYER_CODE
<< L4_KWQ_OFFLOAD_PG_LAYER_CODE_SHIFT
;
1207 l4kwqe
->l2hdr_nbytes
= ETH_HLEN
;
1209 l4kwqe
->da0
= csk
->ha
[0];
1210 l4kwqe
->da1
= csk
->ha
[1];
1211 l4kwqe
->da2
= csk
->ha
[2];
1212 l4kwqe
->da3
= csk
->ha
[3];
1213 l4kwqe
->da4
= csk
->ha
[4];
1214 l4kwqe
->da5
= csk
->ha
[5];
1216 l4kwqe
->sa0
= dev
->mac_addr
[0];
1217 l4kwqe
->sa1
= dev
->mac_addr
[1];
1218 l4kwqe
->sa2
= dev
->mac_addr
[2];
1219 l4kwqe
->sa3
= dev
->mac_addr
[3];
1220 l4kwqe
->sa4
= dev
->mac_addr
[4];
1221 l4kwqe
->sa5
= dev
->mac_addr
[5];
1223 l4kwqe
->etype
= ETH_P_IP
;
1224 l4kwqe
->ipid_count
= DEF_IPID_COUNT
;
1225 l4kwqe
->host_opaque
= csk
->l5_cid
;
1228 l4kwqe
->pg_flags
|= L4_KWQ_OFFLOAD_PG_VLAN_TAGGING
;
1229 l4kwqe
->vlan_tag
= csk
->vlan_id
;
1230 l4kwqe
->l2hdr_nbytes
+= 4;
1233 return dev
->submit_kwqes(dev
, wqes
, 1);
1236 static int cnic_cm_update_pg(struct cnic_sock
*csk
)
1238 struct cnic_dev
*dev
= csk
->dev
;
1239 struct l4_kwq_update_pg
*l4kwqe
;
1240 struct kwqe
*wqes
[1];
1242 l4kwqe
= (struct l4_kwq_update_pg
*) &csk
->kwqe1
;
1243 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1244 wqes
[0] = (struct kwqe
*) l4kwqe
;
1246 l4kwqe
->opcode
= L4_KWQE_OPCODE_VALUE_UPDATE_PG
;
1248 L4_LAYER_CODE
<< L4_KWQ_UPDATE_PG_LAYER_CODE_SHIFT
;
1249 l4kwqe
->pg_cid
= csk
->pg_cid
;
1251 l4kwqe
->da0
= csk
->ha
[0];
1252 l4kwqe
->da1
= csk
->ha
[1];
1253 l4kwqe
->da2
= csk
->ha
[2];
1254 l4kwqe
->da3
= csk
->ha
[3];
1255 l4kwqe
->da4
= csk
->ha
[4];
1256 l4kwqe
->da5
= csk
->ha
[5];
1258 l4kwqe
->pg_host_opaque
= csk
->l5_cid
;
1259 l4kwqe
->pg_valids
= L4_KWQ_UPDATE_PG_VALIDS_DA
;
1261 return dev
->submit_kwqes(dev
, wqes
, 1);
1264 static int cnic_cm_upload_pg(struct cnic_sock
*csk
)
1266 struct cnic_dev
*dev
= csk
->dev
;
1267 struct l4_kwq_upload
*l4kwqe
;
1268 struct kwqe
*wqes
[1];
1270 l4kwqe
= (struct l4_kwq_upload
*) &csk
->kwqe1
;
1271 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1272 wqes
[0] = (struct kwqe
*) l4kwqe
;
1274 l4kwqe
->opcode
= L4_KWQE_OPCODE_VALUE_UPLOAD_PG
;
1276 L4_LAYER_CODE
<< L4_KWQ_UPLOAD_LAYER_CODE_SHIFT
;
1277 l4kwqe
->cid
= csk
->pg_cid
;
1279 return dev
->submit_kwqes(dev
, wqes
, 1);
1282 static int cnic_cm_conn_req(struct cnic_sock
*csk
)
1284 struct cnic_dev
*dev
= csk
->dev
;
1285 struct l4_kwq_connect_req1
*l4kwqe1
;
1286 struct l4_kwq_connect_req2
*l4kwqe2
;
1287 struct l4_kwq_connect_req3
*l4kwqe3
;
1288 struct kwqe
*wqes
[3];
1292 l4kwqe1
= (struct l4_kwq_connect_req1
*) &csk
->kwqe1
;
1293 l4kwqe2
= (struct l4_kwq_connect_req2
*) &csk
->kwqe2
;
1294 l4kwqe3
= (struct l4_kwq_connect_req3
*) &csk
->kwqe3
;
1295 memset(l4kwqe1
, 0, sizeof(*l4kwqe1
));
1296 memset(l4kwqe2
, 0, sizeof(*l4kwqe2
));
1297 memset(l4kwqe3
, 0, sizeof(*l4kwqe3
));
1299 l4kwqe3
->op_code
= L4_KWQE_OPCODE_VALUE_CONNECT3
;
1301 L4_LAYER_CODE
<< L4_KWQ_CONNECT_REQ3_LAYER_CODE_SHIFT
;
1302 l4kwqe3
->ka_timeout
= csk
->ka_timeout
;
1303 l4kwqe3
->ka_interval
= csk
->ka_interval
;
1304 l4kwqe3
->ka_max_probe_count
= csk
->ka_max_probe_count
;
1305 l4kwqe3
->tos
= csk
->tos
;
1306 l4kwqe3
->ttl
= csk
->ttl
;
1307 l4kwqe3
->snd_seq_scale
= csk
->snd_seq_scale
;
1308 l4kwqe3
->pmtu
= csk
->mtu
;
1309 l4kwqe3
->rcv_buf
= csk
->rcv_buf
;
1310 l4kwqe3
->snd_buf
= csk
->snd_buf
;
1311 l4kwqe3
->seed
= csk
->seed
;
1313 wqes
[0] = (struct kwqe
*) l4kwqe1
;
1314 if (test_bit(SK_F_IPV6
, &csk
->flags
)) {
1315 wqes
[1] = (struct kwqe
*) l4kwqe2
;
1316 wqes
[2] = (struct kwqe
*) l4kwqe3
;
1319 l4kwqe1
->conn_flags
= L4_KWQ_CONNECT_REQ1_IP_V6
;
1320 l4kwqe2
->op_code
= L4_KWQE_OPCODE_VALUE_CONNECT2
;
1322 L4_KWQ_CONNECT_REQ2_LINKED_WITH_NEXT
|
1323 L4_LAYER_CODE
<< L4_KWQ_CONNECT_REQ2_LAYER_CODE_SHIFT
;
1324 l4kwqe2
->src_ip_v6_2
= be32_to_cpu(csk
->src_ip
[1]);
1325 l4kwqe2
->src_ip_v6_3
= be32_to_cpu(csk
->src_ip
[2]);
1326 l4kwqe2
->src_ip_v6_4
= be32_to_cpu(csk
->src_ip
[3]);
1327 l4kwqe2
->dst_ip_v6_2
= be32_to_cpu(csk
->dst_ip
[1]);
1328 l4kwqe2
->dst_ip_v6_3
= be32_to_cpu(csk
->dst_ip
[2]);
1329 l4kwqe2
->dst_ip_v6_4
= be32_to_cpu(csk
->dst_ip
[3]);
1330 l4kwqe3
->mss
= l4kwqe3
->pmtu
- sizeof(struct ipv6hdr
) -
1331 sizeof(struct tcphdr
);
1333 wqes
[1] = (struct kwqe
*) l4kwqe3
;
1334 l4kwqe3
->mss
= l4kwqe3
->pmtu
- sizeof(struct iphdr
) -
1335 sizeof(struct tcphdr
);
1338 l4kwqe1
->op_code
= L4_KWQE_OPCODE_VALUE_CONNECT1
;
1340 (L4_LAYER_CODE
<< L4_KWQ_CONNECT_REQ1_LAYER_CODE_SHIFT
) |
1341 L4_KWQ_CONNECT_REQ3_LINKED_WITH_NEXT
;
1342 l4kwqe1
->cid
= csk
->cid
;
1343 l4kwqe1
->pg_cid
= csk
->pg_cid
;
1344 l4kwqe1
->src_ip
= be32_to_cpu(csk
->src_ip
[0]);
1345 l4kwqe1
->dst_ip
= be32_to_cpu(csk
->dst_ip
[0]);
1346 l4kwqe1
->src_port
= be16_to_cpu(csk
->src_port
);
1347 l4kwqe1
->dst_port
= be16_to_cpu(csk
->dst_port
);
1348 if (csk
->tcp_flags
& SK_TCP_NO_DELAY_ACK
)
1349 tcp_flags
|= L4_KWQ_CONNECT_REQ1_NO_DELAY_ACK
;
1350 if (csk
->tcp_flags
& SK_TCP_KEEP_ALIVE
)
1351 tcp_flags
|= L4_KWQ_CONNECT_REQ1_KEEP_ALIVE
;
1352 if (csk
->tcp_flags
& SK_TCP_NAGLE
)
1353 tcp_flags
|= L4_KWQ_CONNECT_REQ1_NAGLE_ENABLE
;
1354 if (csk
->tcp_flags
& SK_TCP_TIMESTAMP
)
1355 tcp_flags
|= L4_KWQ_CONNECT_REQ1_TIME_STAMP
;
1356 if (csk
->tcp_flags
& SK_TCP_SACK
)
1357 tcp_flags
|= L4_KWQ_CONNECT_REQ1_SACK
;
1358 if (csk
->tcp_flags
& SK_TCP_SEG_SCALING
)
1359 tcp_flags
|= L4_KWQ_CONNECT_REQ1_SEG_SCALING
;
1361 l4kwqe1
->tcp_flags
= tcp_flags
;
1363 return dev
->submit_kwqes(dev
, wqes
, num_wqes
);
1366 static int cnic_cm_close_req(struct cnic_sock
*csk
)
1368 struct cnic_dev
*dev
= csk
->dev
;
1369 struct l4_kwq_close_req
*l4kwqe
;
1370 struct kwqe
*wqes
[1];
1372 l4kwqe
= (struct l4_kwq_close_req
*) &csk
->kwqe2
;
1373 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1374 wqes
[0] = (struct kwqe
*) l4kwqe
;
1376 l4kwqe
->op_code
= L4_KWQE_OPCODE_VALUE_CLOSE
;
1377 l4kwqe
->flags
= L4_LAYER_CODE
<< L4_KWQ_CLOSE_REQ_LAYER_CODE_SHIFT
;
1378 l4kwqe
->cid
= csk
->cid
;
1380 return dev
->submit_kwqes(dev
, wqes
, 1);
1383 static int cnic_cm_abort_req(struct cnic_sock
*csk
)
1385 struct cnic_dev
*dev
= csk
->dev
;
1386 struct l4_kwq_reset_req
*l4kwqe
;
1387 struct kwqe
*wqes
[1];
1389 l4kwqe
= (struct l4_kwq_reset_req
*) &csk
->kwqe2
;
1390 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1391 wqes
[0] = (struct kwqe
*) l4kwqe
;
1393 l4kwqe
->op_code
= L4_KWQE_OPCODE_VALUE_RESET
;
1394 l4kwqe
->flags
= L4_LAYER_CODE
<< L4_KWQ_RESET_REQ_LAYER_CODE_SHIFT
;
1395 l4kwqe
->cid
= csk
->cid
;
1397 return dev
->submit_kwqes(dev
, wqes
, 1);
1400 static int cnic_cm_create(struct cnic_dev
*dev
, int ulp_type
, u32 cid
,
1401 u32 l5_cid
, struct cnic_sock
**csk
, void *context
)
1403 struct cnic_local
*cp
= dev
->cnic_priv
;
1404 struct cnic_sock
*csk1
;
1406 if (l5_cid
>= MAX_CM_SK_TBL_SZ
)
1409 csk1
= &cp
->csk_tbl
[l5_cid
];
1410 if (atomic_read(&csk1
->ref_count
))
1413 if (test_and_set_bit(SK_F_INUSE
, &csk1
->flags
))
1418 csk1
->l5_cid
= l5_cid
;
1419 csk1
->ulp_type
= ulp_type
;
1420 csk1
->context
= context
;
1422 csk1
->ka_timeout
= DEF_KA_TIMEOUT
;
1423 csk1
->ka_interval
= DEF_KA_INTERVAL
;
1424 csk1
->ka_max_probe_count
= DEF_KA_MAX_PROBE_COUNT
;
1425 csk1
->tos
= DEF_TOS
;
1426 csk1
->ttl
= DEF_TTL
;
1427 csk1
->snd_seq_scale
= DEF_SND_SEQ_SCALE
;
1428 csk1
->rcv_buf
= DEF_RCV_BUF
;
1429 csk1
->snd_buf
= DEF_SND_BUF
;
1430 csk1
->seed
= DEF_SEED
;
1436 static void cnic_cm_cleanup(struct cnic_sock
*csk
)
1438 if (csk
->src_port
) {
1439 struct cnic_dev
*dev
= csk
->dev
;
1440 struct cnic_local
*cp
= dev
->cnic_priv
;
1442 cnic_free_id(&cp
->csk_port_tbl
, csk
->src_port
);
1447 static void cnic_close_conn(struct cnic_sock
*csk
)
1449 if (test_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
)) {
1450 cnic_cm_upload_pg(csk
);
1451 clear_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
);
1453 cnic_cm_cleanup(csk
);
1456 static int cnic_cm_destroy(struct cnic_sock
*csk
)
1458 if (!cnic_in_use(csk
))
1462 clear_bit(SK_F_INUSE
, &csk
->flags
);
1463 smp_mb__after_clear_bit();
1464 while (atomic_read(&csk
->ref_count
) != 1)
1466 cnic_cm_cleanup(csk
);
1473 static inline u16
cnic_get_vlan(struct net_device
*dev
,
1474 struct net_device
**vlan_dev
)
1476 if (dev
->priv_flags
& IFF_802_1Q_VLAN
) {
1477 *vlan_dev
= vlan_dev_real_dev(dev
);
1478 return vlan_dev_vlan_id(dev
);
1484 static int cnic_get_v4_route(struct sockaddr_in
*dst_addr
,
1485 struct dst_entry
**dst
)
1487 #if defined(CONFIG_INET)
1492 memset(&fl
, 0, sizeof(fl
));
1493 fl
.nl_u
.ip4_u
.daddr
= dst_addr
->sin_addr
.s_addr
;
1495 err
= ip_route_output_key(&init_net
, &rt
, &fl
);
1500 return -ENETUNREACH
;
1504 static int cnic_get_v6_route(struct sockaddr_in6
*dst_addr
,
1505 struct dst_entry
**dst
)
1507 #if defined(CONFIG_IPV6) || (defined(CONFIG_IPV6_MODULE) && defined(MODULE))
1510 memset(&fl
, 0, sizeof(fl
));
1511 ipv6_addr_copy(&fl
.fl6_dst
, &dst_addr
->sin6_addr
);
1512 if (ipv6_addr_type(&fl
.fl6_dst
) & IPV6_ADDR_LINKLOCAL
)
1513 fl
.oif
= dst_addr
->sin6_scope_id
;
1515 *dst
= ip6_route_output(&init_net
, NULL
, &fl
);
1520 return -ENETUNREACH
;
1523 static struct cnic_dev
*cnic_cm_select_dev(struct sockaddr_in
*dst_addr
,
1526 struct cnic_dev
*dev
= NULL
;
1527 struct dst_entry
*dst
;
1528 struct net_device
*netdev
= NULL
;
1529 int err
= -ENETUNREACH
;
1531 if (dst_addr
->sin_family
== AF_INET
)
1532 err
= cnic_get_v4_route(dst_addr
, &dst
);
1533 else if (dst_addr
->sin_family
== AF_INET6
) {
1534 struct sockaddr_in6
*dst_addr6
=
1535 (struct sockaddr_in6
*) dst_addr
;
1537 err
= cnic_get_v6_route(dst_addr6
, &dst
);
1547 cnic_get_vlan(dst
->dev
, &netdev
);
1549 dev
= cnic_from_netdev(netdev
);
1558 static int cnic_resolve_addr(struct cnic_sock
*csk
, struct cnic_sockaddr
*saddr
)
1560 struct cnic_dev
*dev
= csk
->dev
;
1561 struct cnic_local
*cp
= dev
->cnic_priv
;
1563 return cnic_send_nlmsg(cp
, ISCSI_KEVENT_PATH_REQ
, csk
);
1566 static int cnic_get_route(struct cnic_sock
*csk
, struct cnic_sockaddr
*saddr
)
1568 struct cnic_dev
*dev
= csk
->dev
;
1569 struct cnic_local
*cp
= dev
->cnic_priv
;
1570 int is_v6
, err
, rc
= -ENETUNREACH
;
1571 struct dst_entry
*dst
;
1572 struct net_device
*realdev
;
1575 if (saddr
->local
.v6
.sin6_family
== AF_INET6
&&
1576 saddr
->remote
.v6
.sin6_family
== AF_INET6
)
1578 else if (saddr
->local
.v4
.sin_family
== AF_INET
&&
1579 saddr
->remote
.v4
.sin_family
== AF_INET
)
1584 clear_bit(SK_F_IPV6
, &csk
->flags
);
1587 #if defined(CONFIG_IPV6) || (defined(CONFIG_IPV6_MODULE) && defined(MODULE))
1588 set_bit(SK_F_IPV6
, &csk
->flags
);
1589 err
= cnic_get_v6_route(&saddr
->remote
.v6
, &dst
);
1593 if (!dst
|| dst
->error
|| !dst
->dev
)
1596 memcpy(&csk
->dst_ip
[0], &saddr
->remote
.v6
.sin6_addr
,
1597 sizeof(struct in6_addr
));
1598 csk
->dst_port
= saddr
->remote
.v6
.sin6_port
;
1599 local_port
= saddr
->local
.v6
.sin6_port
;
1605 err
= cnic_get_v4_route(&saddr
->remote
.v4
, &dst
);
1609 if (!dst
|| dst
->error
|| !dst
->dev
)
1612 csk
->dst_ip
[0] = saddr
->remote
.v4
.sin_addr
.s_addr
;
1613 csk
->dst_port
= saddr
->remote
.v4
.sin_port
;
1614 local_port
= saddr
->local
.v4
.sin_port
;
1617 csk
->vlan_id
= cnic_get_vlan(dst
->dev
, &realdev
);
1618 if (realdev
!= dev
->netdev
)
1621 if (local_port
>= CNIC_LOCAL_PORT_MIN
&&
1622 local_port
< CNIC_LOCAL_PORT_MAX
) {
1623 if (cnic_alloc_id(&cp
->csk_port_tbl
, local_port
))
1629 local_port
= cnic_alloc_new_id(&cp
->csk_port_tbl
);
1630 if (local_port
== -1) {
1635 csk
->src_port
= local_port
;
1637 csk
->mtu
= dst_mtu(dst
);
1645 static void cnic_init_csk_state(struct cnic_sock
*csk
)
1648 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
1649 clear_bit(SK_F_CLOSING
, &csk
->flags
);
1652 static int cnic_cm_connect(struct cnic_sock
*csk
, struct cnic_sockaddr
*saddr
)
1656 if (!cnic_in_use(csk
))
1659 if (test_and_set_bit(SK_F_CONNECT_START
, &csk
->flags
))
1662 cnic_init_csk_state(csk
);
1664 err
= cnic_get_route(csk
, saddr
);
1668 err
= cnic_resolve_addr(csk
, saddr
);
1673 clear_bit(SK_F_CONNECT_START
, &csk
->flags
);
1677 static int cnic_cm_abort(struct cnic_sock
*csk
)
1679 struct cnic_local
*cp
= csk
->dev
->cnic_priv
;
1682 if (!cnic_in_use(csk
))
1685 if (cnic_abort_prep(csk
))
1686 return cnic_cm_abort_req(csk
);
1688 /* Getting here means that we haven't started connect, or
1689 * connect was not successful.
1692 csk
->state
= L4_KCQE_OPCODE_VALUE_RESET_COMP
;
1693 if (test_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
))
1694 opcode
= csk
->state
;
1696 opcode
= L5CM_RAMROD_CMD_ID_TERMINATE_OFFLOAD
;
1697 cp
->close_conn(csk
, opcode
);
1702 static int cnic_cm_close(struct cnic_sock
*csk
)
1704 if (!cnic_in_use(csk
))
1707 if (cnic_close_prep(csk
)) {
1708 csk
->state
= L4_KCQE_OPCODE_VALUE_CLOSE_COMP
;
1709 return cnic_cm_close_req(csk
);
1714 static void cnic_cm_upcall(struct cnic_local
*cp
, struct cnic_sock
*csk
,
1717 struct cnic_ulp_ops
*ulp_ops
;
1718 int ulp_type
= csk
->ulp_type
;
1721 ulp_ops
= rcu_dereference(cp
->ulp_ops
[ulp_type
]);
1723 if (opcode
== L4_KCQE_OPCODE_VALUE_CONNECT_COMPLETE
)
1724 ulp_ops
->cm_connect_complete(csk
);
1725 else if (opcode
== L4_KCQE_OPCODE_VALUE_CLOSE_COMP
)
1726 ulp_ops
->cm_close_complete(csk
);
1727 else if (opcode
== L4_KCQE_OPCODE_VALUE_RESET_RECEIVED
)
1728 ulp_ops
->cm_remote_abort(csk
);
1729 else if (opcode
== L4_KCQE_OPCODE_VALUE_RESET_COMP
)
1730 ulp_ops
->cm_abort_complete(csk
);
1731 else if (opcode
== L4_KCQE_OPCODE_VALUE_CLOSE_RECEIVED
)
1732 ulp_ops
->cm_remote_close(csk
);
1737 static int cnic_cm_set_pg(struct cnic_sock
*csk
)
1739 if (cnic_offld_prep(csk
)) {
1740 if (test_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
))
1741 cnic_cm_update_pg(csk
);
1743 cnic_cm_offload_pg(csk
);
1748 static void cnic_cm_process_offld_pg(struct cnic_dev
*dev
, struct l4_kcq
*kcqe
)
1750 struct cnic_local
*cp
= dev
->cnic_priv
;
1751 u32 l5_cid
= kcqe
->pg_host_opaque
;
1752 u8 opcode
= kcqe
->op_code
;
1753 struct cnic_sock
*csk
= &cp
->csk_tbl
[l5_cid
];
1756 if (!cnic_in_use(csk
))
1759 if (opcode
== L4_KCQE_OPCODE_VALUE_UPDATE_PG
) {
1760 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
1763 csk
->pg_cid
= kcqe
->pg_cid
;
1764 set_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
);
1765 cnic_cm_conn_req(csk
);
1771 static void cnic_cm_process_kcqe(struct cnic_dev
*dev
, struct kcqe
*kcqe
)
1773 struct cnic_local
*cp
= dev
->cnic_priv
;
1774 struct l4_kcq
*l4kcqe
= (struct l4_kcq
*) kcqe
;
1775 u8 opcode
= l4kcqe
->op_code
;
1777 struct cnic_sock
*csk
;
1779 if (opcode
== L4_KCQE_OPCODE_VALUE_OFFLOAD_PG
||
1780 opcode
== L4_KCQE_OPCODE_VALUE_UPDATE_PG
) {
1781 cnic_cm_process_offld_pg(dev
, l4kcqe
);
1785 l5_cid
= l4kcqe
->conn_id
;
1787 l5_cid
= l4kcqe
->cid
;
1788 if (l5_cid
>= MAX_CM_SK_TBL_SZ
)
1791 csk
= &cp
->csk_tbl
[l5_cid
];
1794 if (!cnic_in_use(csk
)) {
1800 case L4_KCQE_OPCODE_VALUE_CONNECT_COMPLETE
:
1801 if (l4kcqe
->status
== 0)
1802 set_bit(SK_F_OFFLD_COMPLETE
, &csk
->flags
);
1804 smp_mb__before_clear_bit();
1805 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
1806 cnic_cm_upcall(cp
, csk
, opcode
);
1809 case L4_KCQE_OPCODE_VALUE_RESET_RECEIVED
:
1810 if (test_and_clear_bit(SK_F_OFFLD_COMPLETE
, &csk
->flags
))
1811 csk
->state
= opcode
;
1813 case L4_KCQE_OPCODE_VALUE_CLOSE_COMP
:
1814 case L4_KCQE_OPCODE_VALUE_RESET_COMP
:
1815 cp
->close_conn(csk
, opcode
);
1818 case L4_KCQE_OPCODE_VALUE_CLOSE_RECEIVED
:
1819 cnic_cm_upcall(cp
, csk
, opcode
);
1825 static void cnic_cm_indicate_kcqe(void *data
, struct kcqe
*kcqe
[], u32 num
)
1827 struct cnic_dev
*dev
= data
;
1830 for (i
= 0; i
< num
; i
++)
1831 cnic_cm_process_kcqe(dev
, kcqe
[i
]);
1834 static struct cnic_ulp_ops cm_ulp_ops
= {
1835 .indicate_kcqes
= cnic_cm_indicate_kcqe
,
1838 static void cnic_cm_free_mem(struct cnic_dev
*dev
)
1840 struct cnic_local
*cp
= dev
->cnic_priv
;
1844 cnic_free_id_tbl(&cp
->csk_port_tbl
);
1847 static int cnic_cm_alloc_mem(struct cnic_dev
*dev
)
1849 struct cnic_local
*cp
= dev
->cnic_priv
;
1851 cp
->csk_tbl
= kzalloc(sizeof(struct cnic_sock
) * MAX_CM_SK_TBL_SZ
,
1856 if (cnic_init_id_tbl(&cp
->csk_port_tbl
, CNIC_LOCAL_PORT_RANGE
,
1857 CNIC_LOCAL_PORT_MIN
)) {
1858 cnic_cm_free_mem(dev
);
1864 static int cnic_ready_to_close(struct cnic_sock
*csk
, u32 opcode
)
1866 if ((opcode
== csk
->state
) ||
1867 (opcode
== L4_KCQE_OPCODE_VALUE_RESET_RECEIVED
&&
1868 csk
->state
== L4_KCQE_OPCODE_VALUE_CLOSE_COMP
)) {
1869 if (!test_and_set_bit(SK_F_CLOSING
, &csk
->flags
))
1875 static void cnic_close_bnx2_conn(struct cnic_sock
*csk
, u32 opcode
)
1877 struct cnic_dev
*dev
= csk
->dev
;
1878 struct cnic_local
*cp
= dev
->cnic_priv
;
1880 clear_bit(SK_F_CONNECT_START
, &csk
->flags
);
1881 if (cnic_ready_to_close(csk
, opcode
)) {
1882 cnic_close_conn(csk
);
1883 cnic_cm_upcall(cp
, csk
, opcode
);
1887 static void cnic_cm_stop_bnx2_hw(struct cnic_dev
*dev
)
1891 static int cnic_cm_init_bnx2_hw(struct cnic_dev
*dev
)
1895 get_random_bytes(&seed
, 4);
1896 cnic_ctx_wr(dev
, 45, 0, seed
);
1900 static int cnic_cm_open(struct cnic_dev
*dev
)
1902 struct cnic_local
*cp
= dev
->cnic_priv
;
1905 err
= cnic_cm_alloc_mem(dev
);
1909 err
= cp
->start_cm(dev
);
1914 dev
->cm_create
= cnic_cm_create
;
1915 dev
->cm_destroy
= cnic_cm_destroy
;
1916 dev
->cm_connect
= cnic_cm_connect
;
1917 dev
->cm_abort
= cnic_cm_abort
;
1918 dev
->cm_close
= cnic_cm_close
;
1919 dev
->cm_select_dev
= cnic_cm_select_dev
;
1921 cp
->ulp_handle
[CNIC_ULP_L4
] = dev
;
1922 rcu_assign_pointer(cp
->ulp_ops
[CNIC_ULP_L4
], &cm_ulp_ops
);
1926 cnic_cm_free_mem(dev
);
1930 static int cnic_cm_shutdown(struct cnic_dev
*dev
)
1932 struct cnic_local
*cp
= dev
->cnic_priv
;
1940 for (i
= 0; i
< MAX_CM_SK_TBL_SZ
; i
++) {
1941 struct cnic_sock
*csk
= &cp
->csk_tbl
[i
];
1943 clear_bit(SK_F_INUSE
, &csk
->flags
);
1944 cnic_cm_cleanup(csk
);
1946 cnic_cm_free_mem(dev
);
1951 static void cnic_init_context(struct cnic_dev
*dev
, u32 cid
)
1953 struct cnic_local
*cp
= dev
->cnic_priv
;
1957 if (CHIP_NUM(cp
) == CHIP_NUM_5709
)
1960 cid_addr
= GET_CID_ADDR(cid
);
1962 for (i
= 0; i
< CTX_SIZE
; i
+= 4)
1963 cnic_ctx_wr(dev
, cid_addr
, i
, 0);
1966 static int cnic_setup_5709_context(struct cnic_dev
*dev
, int valid
)
1968 struct cnic_local
*cp
= dev
->cnic_priv
;
1970 u32 valid_bit
= valid
? BNX2_CTX_HOST_PAGE_TBL_DATA0_VALID
: 0;
1972 if (CHIP_NUM(cp
) != CHIP_NUM_5709
)
1975 for (i
= 0; i
< cp
->ctx_blks
; i
++) {
1977 u32 idx
= cp
->ctx_arr
[i
].cid
/ cp
->cids_per_blk
;
1980 memset(cp
->ctx_arr
[i
].ctx
, 0, BCM_PAGE_SIZE
);
1982 CNIC_WR(dev
, BNX2_CTX_HOST_PAGE_TBL_DATA0
,
1983 (cp
->ctx_arr
[i
].mapping
& 0xffffffff) | valid_bit
);
1984 CNIC_WR(dev
, BNX2_CTX_HOST_PAGE_TBL_DATA1
,
1985 (u64
) cp
->ctx_arr
[i
].mapping
>> 32);
1986 CNIC_WR(dev
, BNX2_CTX_HOST_PAGE_TBL_CTRL
, idx
|
1987 BNX2_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ
);
1988 for (j
= 0; j
< 10; j
++) {
1990 val
= CNIC_RD(dev
, BNX2_CTX_HOST_PAGE_TBL_CTRL
);
1991 if (!(val
& BNX2_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ
))
1995 if (val
& BNX2_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ
) {
2003 static void cnic_free_irq(struct cnic_dev
*dev
)
2005 struct cnic_local
*cp
= dev
->cnic_priv
;
2006 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2008 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2009 cp
->disable_int_sync(dev
);
2010 tasklet_disable(&cp
->cnic_irq_task
);
2011 free_irq(ethdev
->irq_arr
[0].vector
, dev
);
2015 static int cnic_init_bnx2_irq(struct cnic_dev
*dev
)
2017 struct cnic_local
*cp
= dev
->cnic_priv
;
2018 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2020 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2022 int sblk_num
= cp
->status_blk_num
;
2023 u32 base
= ((sblk_num
- 1) * BNX2_HC_SB_CONFIG_SIZE
) +
2024 BNX2_HC_SB_CONFIG_1
;
2026 CNIC_WR(dev
, base
, BNX2_HC_SB_CONFIG_1_ONE_SHOT
);
2028 CNIC_WR(dev
, base
+ BNX2_HC_COMP_PROD_TRIP_OFF
, (2 << 16) | 8);
2029 CNIC_WR(dev
, base
+ BNX2_HC_COM_TICKS_OFF
, (64 << 16) | 220);
2030 CNIC_WR(dev
, base
+ BNX2_HC_CMD_TICKS_OFF
, (64 << 16) | 220);
2032 cp
->bnx2_status_blk
= cp
->status_blk
;
2033 cp
->last_status_idx
= cp
->bnx2_status_blk
->status_idx
;
2034 tasklet_init(&cp
->cnic_irq_task
, &cnic_service_bnx2_msix
,
2035 (unsigned long) dev
);
2036 err
= request_irq(ethdev
->irq_arr
[0].vector
, cnic_irq
, 0,
2039 tasklet_disable(&cp
->cnic_irq_task
);
2042 while (cp
->bnx2_status_blk
->status_completion_producer_index
&&
2044 CNIC_WR(dev
, BNX2_HC_COALESCE_NOW
,
2045 1 << (11 + sblk_num
));
2050 if (cp
->bnx2_status_blk
->status_completion_producer_index
) {
2056 struct status_block
*sblk
= cp
->status_blk
;
2057 u32 hc_cmd
= CNIC_RD(dev
, BNX2_HC_COMMAND
);
2060 while (sblk
->status_completion_producer_index
&& i
< 10) {
2061 CNIC_WR(dev
, BNX2_HC_COMMAND
,
2062 hc_cmd
| BNX2_HC_COMMAND_COAL_NOW_WO_INT
);
2067 if (sblk
->status_completion_producer_index
)
2074 printk(KERN_ERR PFX
"%s: " "KCQ index not resetting to 0.\n",
2079 static void cnic_enable_bnx2_int(struct cnic_dev
*dev
)
2081 struct cnic_local
*cp
= dev
->cnic_priv
;
2082 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2084 if (!(ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
))
2087 CNIC_WR(dev
, BNX2_PCICFG_INT_ACK_CMD
, cp
->int_num
|
2088 BNX2_PCICFG_INT_ACK_CMD_INDEX_VALID
| cp
->last_status_idx
);
2091 static void cnic_disable_bnx2_int_sync(struct cnic_dev
*dev
)
2093 struct cnic_local
*cp
= dev
->cnic_priv
;
2094 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2096 if (!(ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
))
2099 CNIC_WR(dev
, BNX2_PCICFG_INT_ACK_CMD
, cp
->int_num
|
2100 BNX2_PCICFG_INT_ACK_CMD_MASK_INT
);
2101 CNIC_RD(dev
, BNX2_PCICFG_INT_ACK_CMD
);
2102 synchronize_irq(ethdev
->irq_arr
[0].vector
);
2105 static void cnic_init_bnx2_tx_ring(struct cnic_dev
*dev
)
2107 struct cnic_local
*cp
= dev
->cnic_priv
;
2108 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2109 u32 cid_addr
, tx_cid
, sb_id
;
2110 u32 val
, offset0
, offset1
, offset2
, offset3
;
2114 struct status_block
*s_blk
= cp
->status_blk
;
2116 sb_id
= cp
->status_blk_num
;
2118 cnic_init_context(dev
, tx_cid
);
2119 cnic_init_context(dev
, tx_cid
+ 1);
2120 cp
->tx_cons_ptr
= &s_blk
->status_tx_quick_consumer_index2
;
2121 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2122 struct status_block_msix
*sblk
= cp
->status_blk
;
2124 tx_cid
= TX_TSS_CID
+ sb_id
- 1;
2125 cnic_init_context(dev
, tx_cid
);
2126 CNIC_WR(dev
, BNX2_TSCH_TSS_CFG
, (sb_id
<< 24) |
2128 cp
->tx_cons_ptr
= &sblk
->status_tx_quick_consumer_index
;
2130 cp
->tx_cons
= *cp
->tx_cons_ptr
;
2132 cid_addr
= GET_CID_ADDR(tx_cid
);
2133 if (CHIP_NUM(cp
) == CHIP_NUM_5709
) {
2134 u32 cid_addr2
= GET_CID_ADDR(tx_cid
+ 4) + 0x40;
2136 for (i
= 0; i
< PHY_CTX_SIZE
; i
+= 4)
2137 cnic_ctx_wr(dev
, cid_addr2
, i
, 0);
2139 offset0
= BNX2_L2CTX_TYPE_XI
;
2140 offset1
= BNX2_L2CTX_CMD_TYPE_XI
;
2141 offset2
= BNX2_L2CTX_TBDR_BHADDR_HI_XI
;
2142 offset3
= BNX2_L2CTX_TBDR_BHADDR_LO_XI
;
2144 offset0
= BNX2_L2CTX_TYPE
;
2145 offset1
= BNX2_L2CTX_CMD_TYPE
;
2146 offset2
= BNX2_L2CTX_TBDR_BHADDR_HI
;
2147 offset3
= BNX2_L2CTX_TBDR_BHADDR_LO
;
2149 val
= BNX2_L2CTX_TYPE_TYPE_L2
| BNX2_L2CTX_TYPE_SIZE_L2
;
2150 cnic_ctx_wr(dev
, cid_addr
, offset0
, val
);
2152 val
= BNX2_L2CTX_CMD_TYPE_TYPE_L2
| (8 << 16);
2153 cnic_ctx_wr(dev
, cid_addr
, offset1
, val
);
2155 txbd
= (struct tx_bd
*) cp
->l2_ring
;
2157 buf_map
= cp
->l2_buf_map
;
2158 for (i
= 0; i
< MAX_TX_DESC_CNT
; i
++, txbd
++) {
2159 txbd
->tx_bd_haddr_hi
= (u64
) buf_map
>> 32;
2160 txbd
->tx_bd_haddr_lo
= (u64
) buf_map
& 0xffffffff;
2162 val
= (u64
) cp
->l2_ring_map
>> 32;
2163 cnic_ctx_wr(dev
, cid_addr
, offset2
, val
);
2164 txbd
->tx_bd_haddr_hi
= val
;
2166 val
= (u64
) cp
->l2_ring_map
& 0xffffffff;
2167 cnic_ctx_wr(dev
, cid_addr
, offset3
, val
);
2168 txbd
->tx_bd_haddr_lo
= val
;
2171 static void cnic_init_bnx2_rx_ring(struct cnic_dev
*dev
)
2173 struct cnic_local
*cp
= dev
->cnic_priv
;
2174 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2175 u32 cid_addr
, sb_id
, val
, coal_reg
, coal_val
;
2178 struct status_block
*s_blk
= cp
->status_blk
;
2180 sb_id
= cp
->status_blk_num
;
2181 cnic_init_context(dev
, 2);
2182 cp
->rx_cons_ptr
= &s_blk
->status_rx_quick_consumer_index2
;
2183 coal_reg
= BNX2_HC_COMMAND
;
2184 coal_val
= CNIC_RD(dev
, coal_reg
);
2185 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2186 struct status_block_msix
*sblk
= cp
->status_blk
;
2188 cp
->rx_cons_ptr
= &sblk
->status_rx_quick_consumer_index
;
2189 coal_reg
= BNX2_HC_COALESCE_NOW
;
2190 coal_val
= 1 << (11 + sb_id
);
2193 while (!(*cp
->rx_cons_ptr
!= 0) && i
< 10) {
2194 CNIC_WR(dev
, coal_reg
, coal_val
);
2199 cp
->rx_cons
= *cp
->rx_cons_ptr
;
2201 cid_addr
= GET_CID_ADDR(2);
2202 val
= BNX2_L2CTX_CTX_TYPE_CTX_BD_CHN_TYPE_VALUE
|
2203 BNX2_L2CTX_CTX_TYPE_SIZE_L2
| (0x02 << 8);
2204 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_CTX_TYPE
, val
);
2207 val
= 2 << BNX2_L2CTX_STATUSB_NUM_SHIFT
;
2209 val
= BNX2_L2CTX_STATUSB_NUM(sb_id
);
2210 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_HOST_BDIDX
, val
);
2212 rxbd
= (struct rx_bd
*) (cp
->l2_ring
+ BCM_PAGE_SIZE
);
2213 for (i
= 0; i
< MAX_RX_DESC_CNT
; i
++, rxbd
++) {
2215 int n
= (i
% cp
->l2_rx_ring_size
) + 1;
2217 buf_map
= cp
->l2_buf_map
+ (n
* cp
->l2_single_buf_size
);
2218 rxbd
->rx_bd_len
= cp
->l2_single_buf_size
;
2219 rxbd
->rx_bd_flags
= RX_BD_FLAGS_START
| RX_BD_FLAGS_END
;
2220 rxbd
->rx_bd_haddr_hi
= (u64
) buf_map
>> 32;
2221 rxbd
->rx_bd_haddr_lo
= (u64
) buf_map
& 0xffffffff;
2223 val
= (u64
) (cp
->l2_ring_map
+ BCM_PAGE_SIZE
) >> 32;
2224 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_NX_BDHADDR_HI
, val
);
2225 rxbd
->rx_bd_haddr_hi
= val
;
2227 val
= (u64
) (cp
->l2_ring_map
+ BCM_PAGE_SIZE
) & 0xffffffff;
2228 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_NX_BDHADDR_LO
, val
);
2229 rxbd
->rx_bd_haddr_lo
= val
;
2231 val
= cnic_reg_rd_ind(dev
, BNX2_RXP_SCRATCH_RXP_FLOOD
);
2232 cnic_reg_wr_ind(dev
, BNX2_RXP_SCRATCH_RXP_FLOOD
, val
| (1 << 2));
2235 static void cnic_shutdown_bnx2_rx_ring(struct cnic_dev
*dev
)
2237 struct kwqe
*wqes
[1], l2kwqe
;
2239 memset(&l2kwqe
, 0, sizeof(l2kwqe
));
2241 l2kwqe
.kwqe_op_flag
= (L2_LAYER_CODE
<< KWQE_FLAGS_LAYER_SHIFT
) |
2242 (L2_KWQE_OPCODE_VALUE_FLUSH
<<
2243 KWQE_OPCODE_SHIFT
) | 2;
2244 dev
->submit_kwqes(dev
, wqes
, 1);
2247 static void cnic_set_bnx2_mac(struct cnic_dev
*dev
)
2249 struct cnic_local
*cp
= dev
->cnic_priv
;
2252 val
= cp
->func
<< 2;
2254 cp
->shmem_base
= cnic_reg_rd_ind(dev
, BNX2_SHM_HDR_ADDR_0
+ val
);
2256 val
= cnic_reg_rd_ind(dev
, cp
->shmem_base
+
2257 BNX2_PORT_HW_CFG_ISCSI_MAC_UPPER
);
2258 dev
->mac_addr
[0] = (u8
) (val
>> 8);
2259 dev
->mac_addr
[1] = (u8
) val
;
2261 CNIC_WR(dev
, BNX2_EMAC_MAC_MATCH4
, val
);
2263 val
= cnic_reg_rd_ind(dev
, cp
->shmem_base
+
2264 BNX2_PORT_HW_CFG_ISCSI_MAC_LOWER
);
2265 dev
->mac_addr
[2] = (u8
) (val
>> 24);
2266 dev
->mac_addr
[3] = (u8
) (val
>> 16);
2267 dev
->mac_addr
[4] = (u8
) (val
>> 8);
2268 dev
->mac_addr
[5] = (u8
) val
;
2270 CNIC_WR(dev
, BNX2_EMAC_MAC_MATCH5
, val
);
2272 val
= 4 | BNX2_RPM_SORT_USER2_BC_EN
;
2273 if (CHIP_NUM(cp
) != CHIP_NUM_5709
)
2274 val
|= BNX2_RPM_SORT_USER2_PROM_VLAN
;
2276 CNIC_WR(dev
, BNX2_RPM_SORT_USER2
, 0x0);
2277 CNIC_WR(dev
, BNX2_RPM_SORT_USER2
, val
);
2278 CNIC_WR(dev
, BNX2_RPM_SORT_USER2
, val
| BNX2_RPM_SORT_USER2_ENA
);
2281 static int cnic_start_bnx2_hw(struct cnic_dev
*dev
)
2283 struct cnic_local
*cp
= dev
->cnic_priv
;
2284 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2285 struct status_block
*sblk
= cp
->status_blk
;
2289 cnic_set_bnx2_mac(dev
);
2291 val
= CNIC_RD(dev
, BNX2_MQ_CONFIG
);
2292 val
&= ~BNX2_MQ_CONFIG_KNL_BYP_BLK_SIZE
;
2293 if (BCM_PAGE_BITS
> 12)
2294 val
|= (12 - 8) << 4;
2296 val
|= (BCM_PAGE_BITS
- 8) << 4;
2298 CNIC_WR(dev
, BNX2_MQ_CONFIG
, val
);
2300 CNIC_WR(dev
, BNX2_HC_COMP_PROD_TRIP
, (2 << 16) | 8);
2301 CNIC_WR(dev
, BNX2_HC_COM_TICKS
, (64 << 16) | 220);
2302 CNIC_WR(dev
, BNX2_HC_CMD_TICKS
, (64 << 16) | 220);
2304 err
= cnic_setup_5709_context(dev
, 1);
2308 cnic_init_context(dev
, KWQ_CID
);
2309 cnic_init_context(dev
, KCQ_CID
);
2311 cp
->kwq_cid_addr
= GET_CID_ADDR(KWQ_CID
);
2312 cp
->kwq_io_addr
= MB_GET_CID_ADDR(KWQ_CID
) + L5_KRNLQ_HOST_QIDX
;
2314 cp
->max_kwq_idx
= MAX_KWQ_IDX
;
2315 cp
->kwq_prod_idx
= 0;
2316 cp
->kwq_con_idx
= 0;
2317 cp
->cnic_local_flags
|= CNIC_LCL_FL_KWQ_INIT
;
2319 if (CHIP_NUM(cp
) == CHIP_NUM_5706
|| CHIP_NUM(cp
) == CHIP_NUM_5708
)
2320 cp
->kwq_con_idx_ptr
= &sblk
->status_rx_quick_consumer_index15
;
2322 cp
->kwq_con_idx_ptr
= &sblk
->status_cmd_consumer_index
;
2324 /* Initialize the kernel work queue context. */
2325 val
= KRNLQ_TYPE_TYPE_KRNLQ
| KRNLQ_SIZE_TYPE_SIZE
|
2326 (BCM_PAGE_BITS
- 8) | KRNLQ_FLAGS_QE_SELF_SEQ
;
2327 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_TYPE
, val
);
2329 val
= (BCM_PAGE_SIZE
/ sizeof(struct kwqe
) - 1) << 16;
2330 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_QE_SELF_SEQ_MAX
, val
);
2332 val
= ((BCM_PAGE_SIZE
/ sizeof(struct kwqe
)) << 16) | KWQ_PAGE_CNT
;
2333 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_PGTBL_NPAGES
, val
);
2335 val
= (u32
) ((u64
) cp
->kwq_info
.pgtbl_map
>> 32);
2336 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_HI
, val
);
2338 val
= (u32
) cp
->kwq_info
.pgtbl_map
;
2339 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_LO
, val
);
2341 cp
->kcq_cid_addr
= GET_CID_ADDR(KCQ_CID
);
2342 cp
->kcq_io_addr
= MB_GET_CID_ADDR(KCQ_CID
) + L5_KRNLQ_HOST_QIDX
;
2344 cp
->kcq_prod_idx
= 0;
2346 /* Initialize the kernel complete queue context. */
2347 val
= KRNLQ_TYPE_TYPE_KRNLQ
| KRNLQ_SIZE_TYPE_SIZE
|
2348 (BCM_PAGE_BITS
- 8) | KRNLQ_FLAGS_QE_SELF_SEQ
;
2349 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_TYPE
, val
);
2351 val
= (BCM_PAGE_SIZE
/ sizeof(struct kcqe
) - 1) << 16;
2352 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_QE_SELF_SEQ_MAX
, val
);
2354 val
= ((BCM_PAGE_SIZE
/ sizeof(struct kcqe
)) << 16) | KCQ_PAGE_CNT
;
2355 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_PGTBL_NPAGES
, val
);
2357 val
= (u32
) ((u64
) cp
->kcq_info
.pgtbl_map
>> 32);
2358 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_HI
, val
);
2360 val
= (u32
) cp
->kcq_info
.pgtbl_map
;
2361 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_LO
, val
);
2364 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2365 u32 sb_id
= cp
->status_blk_num
;
2366 u32 sb
= BNX2_L2CTX_STATUSB_NUM(sb_id
);
2368 cp
->int_num
= sb_id
<< BNX2_PCICFG_INT_ACK_CMD_INT_NUM_SHIFT
;
2369 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_HOST_QIDX
, sb
);
2370 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_HOST_QIDX
, sb
);
2373 /* Enable Commnad Scheduler notification when we write to the
2374 * host producer index of the kernel contexts. */
2375 CNIC_WR(dev
, BNX2_MQ_KNL_CMD_MASK1
, 2);
2377 /* Enable Command Scheduler notification when we write to either
2378 * the Send Queue or Receive Queue producer indexes of the kernel
2379 * bypass contexts. */
2380 CNIC_WR(dev
, BNX2_MQ_KNL_BYP_CMD_MASK1
, 7);
2381 CNIC_WR(dev
, BNX2_MQ_KNL_BYP_WRITE_MASK1
, 7);
2383 /* Notify COM when the driver post an application buffer. */
2384 CNIC_WR(dev
, BNX2_MQ_KNL_RX_V2P_MASK2
, 0x2000);
2386 /* Set the CP and COM doorbells. These two processors polls the
2387 * doorbell for a non zero value before running. This must be done
2388 * after setting up the kernel queue contexts. */
2389 cnic_reg_wr_ind(dev
, BNX2_CP_SCRATCH
+ 0x20, 1);
2390 cnic_reg_wr_ind(dev
, BNX2_COM_SCRATCH
+ 0x20, 1);
2392 cnic_init_bnx2_tx_ring(dev
);
2393 cnic_init_bnx2_rx_ring(dev
);
2395 err
= cnic_init_bnx2_irq(dev
);
2397 printk(KERN_ERR PFX
"%s: cnic_init_irq failed\n",
2399 cnic_reg_wr_ind(dev
, BNX2_CP_SCRATCH
+ 0x20, 0);
2400 cnic_reg_wr_ind(dev
, BNX2_COM_SCRATCH
+ 0x20, 0);
2407 static int cnic_start_hw(struct cnic_dev
*dev
)
2409 struct cnic_local
*cp
= dev
->cnic_priv
;
2410 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2413 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
))
2416 err
= ethdev
->drv_register_cnic(dev
->netdev
, cp
->cnic_ops
, dev
);
2418 printk(KERN_ERR PFX
"%s: register_cnic failed\n",
2423 dev
->regview
= ethdev
->io_base
;
2424 cp
->chip_id
= ethdev
->chip_id
;
2425 pci_dev_get(dev
->pcidev
);
2426 cp
->func
= PCI_FUNC(dev
->pcidev
->devfn
);
2427 cp
->status_blk
= ethdev
->irq_arr
[0].status_blk
;
2428 cp
->status_blk_num
= ethdev
->irq_arr
[0].status_blk_num
;
2430 err
= cp
->alloc_resc(dev
);
2432 printk(KERN_ERR PFX
"%s: allocate resource failure\n",
2437 err
= cp
->start_hw(dev
);
2441 err
= cnic_cm_open(dev
);
2445 set_bit(CNIC_F_CNIC_UP
, &dev
->flags
);
2447 cp
->enable_int(dev
);
2452 ethdev
->drv_unregister_cnic(dev
->netdev
);
2454 pci_dev_put(dev
->pcidev
);
2459 static void cnic_stop_bnx2_hw(struct cnic_dev
*dev
)
2461 struct cnic_local
*cp
= dev
->cnic_priv
;
2462 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2464 cnic_disable_bnx2_int_sync(dev
);
2466 cnic_reg_wr_ind(dev
, BNX2_CP_SCRATCH
+ 0x20, 0);
2467 cnic_reg_wr_ind(dev
, BNX2_COM_SCRATCH
+ 0x20, 0);
2469 cnic_init_context(dev
, KWQ_CID
);
2470 cnic_init_context(dev
, KCQ_CID
);
2472 cnic_setup_5709_context(dev
, 0);
2475 ethdev
->drv_unregister_cnic(dev
->netdev
);
2477 cnic_free_resc(dev
);
2480 static void cnic_stop_hw(struct cnic_dev
*dev
)
2482 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)) {
2483 struct cnic_local
*cp
= dev
->cnic_priv
;
2485 clear_bit(CNIC_F_CNIC_UP
, &dev
->flags
);
2486 rcu_assign_pointer(cp
->ulp_ops
[CNIC_ULP_L4
], NULL
);
2488 cnic_cm_shutdown(dev
);
2490 pci_dev_put(dev
->pcidev
);
2494 static void cnic_free_dev(struct cnic_dev
*dev
)
2498 while ((atomic_read(&dev
->ref_count
) != 0) && i
< 10) {
2502 if (atomic_read(&dev
->ref_count
) != 0)
2503 printk(KERN_ERR PFX
"%s: Failed waiting for ref count to go"
2504 " to zero.\n", dev
->netdev
->name
);
2506 printk(KERN_INFO PFX
"Removed CNIC device: %s\n", dev
->netdev
->name
);
2507 dev_put(dev
->netdev
);
2511 static struct cnic_dev
*cnic_alloc_dev(struct net_device
*dev
,
2512 struct pci_dev
*pdev
)
2514 struct cnic_dev
*cdev
;
2515 struct cnic_local
*cp
;
2518 alloc_size
= sizeof(struct cnic_dev
) + sizeof(struct cnic_local
);
2520 cdev
= kzalloc(alloc_size
, GFP_KERNEL
);
2522 printk(KERN_ERR PFX
"%s: allocate dev struct failure\n",
2528 cdev
->cnic_priv
= (char *)cdev
+ sizeof(struct cnic_dev
);
2529 cdev
->register_device
= cnic_register_device
;
2530 cdev
->unregister_device
= cnic_unregister_device
;
2531 cdev
->iscsi_nl_msg_recv
= cnic_iscsi_nl_msg_recv
;
2533 cp
= cdev
->cnic_priv
;
2536 cp
->l2_single_buf_size
= 0x400;
2537 cp
->l2_rx_ring_size
= 3;
2539 spin_lock_init(&cp
->cnic_ulp_lock
);
2541 printk(KERN_INFO PFX
"Added CNIC device: %s\n", dev
->name
);
2546 static struct cnic_dev
*init_bnx2_cnic(struct net_device
*dev
)
2548 struct pci_dev
*pdev
;
2549 struct cnic_dev
*cdev
;
2550 struct cnic_local
*cp
;
2551 struct cnic_eth_dev
*ethdev
= NULL
;
2552 struct cnic_eth_dev
*(*probe
)(struct net_device
*) = NULL
;
2554 probe
= symbol_get(bnx2_cnic_probe
);
2556 ethdev
= (*probe
)(dev
);
2557 symbol_put_addr(probe
);
2562 pdev
= ethdev
->pdev
;
2568 if (pdev
->device
== PCI_DEVICE_ID_NX2_5709
||
2569 pdev
->device
== PCI_DEVICE_ID_NX2_5709S
) {
2572 pci_read_config_byte(pdev
, PCI_REVISION_ID
, &rev
);
2580 cdev
= cnic_alloc_dev(dev
, pdev
);
2584 set_bit(CNIC_F_BNX2_CLASS
, &cdev
->flags
);
2585 cdev
->submit_kwqes
= cnic_submit_bnx2_kwqes
;
2587 cp
= cdev
->cnic_priv
;
2588 cp
->ethdev
= ethdev
;
2589 cdev
->pcidev
= pdev
;
2591 cp
->cnic_ops
= &cnic_bnx2_ops
;
2592 cp
->start_hw
= cnic_start_bnx2_hw
;
2593 cp
->stop_hw
= cnic_stop_bnx2_hw
;
2594 cp
->setup_pgtbl
= cnic_setup_page_tbl
;
2595 cp
->alloc_resc
= cnic_alloc_bnx2_resc
;
2596 cp
->free_resc
= cnic_free_resc
;
2597 cp
->start_cm
= cnic_cm_init_bnx2_hw
;
2598 cp
->stop_cm
= cnic_cm_stop_bnx2_hw
;
2599 cp
->enable_int
= cnic_enable_bnx2_int
;
2600 cp
->disable_int_sync
= cnic_disable_bnx2_int_sync
;
2601 cp
->close_conn
= cnic_close_bnx2_conn
;
2602 cp
->next_idx
= cnic_bnx2_next_idx
;
2603 cp
->hw_idx
= cnic_bnx2_hw_idx
;
2611 static struct cnic_dev
*is_cnic_dev(struct net_device
*dev
)
2613 struct ethtool_drvinfo drvinfo
;
2614 struct cnic_dev
*cdev
= NULL
;
2616 if (dev
->ethtool_ops
&& dev
->ethtool_ops
->get_drvinfo
) {
2617 memset(&drvinfo
, 0, sizeof(drvinfo
));
2618 dev
->ethtool_ops
->get_drvinfo(dev
, &drvinfo
);
2620 if (!strcmp(drvinfo
.driver
, "bnx2"))
2621 cdev
= init_bnx2_cnic(dev
);
2623 write_lock(&cnic_dev_lock
);
2624 list_add(&cdev
->list
, &cnic_dev_list
);
2625 write_unlock(&cnic_dev_lock
);
2632 * netdev event handler
2634 static int cnic_netdev_event(struct notifier_block
*this, unsigned long event
,
2637 struct net_device
*netdev
= ptr
;
2638 struct cnic_dev
*dev
;
2642 dev
= cnic_from_netdev(netdev
);
2644 if (!dev
&& (event
== NETDEV_REGISTER
|| event
== NETDEV_UP
)) {
2645 /* Check for the hot-plug device */
2646 dev
= is_cnic_dev(netdev
);
2653 struct cnic_local
*cp
= dev
->cnic_priv
;
2657 else if (event
== NETDEV_UNREGISTER
)
2659 else if (event
== NETDEV_UP
) {
2660 mutex_lock(&cnic_lock
);
2661 if (!cnic_start_hw(dev
))
2662 cnic_ulp_start(dev
);
2663 mutex_unlock(&cnic_lock
);
2667 for (if_type
= 0; if_type
< MAX_CNIC_ULP_TYPE
; if_type
++) {
2668 struct cnic_ulp_ops
*ulp_ops
;
2671 ulp_ops
= rcu_dereference(cp
->ulp_ops
[if_type
]);
2672 if (!ulp_ops
|| !ulp_ops
->indicate_netevent
)
2675 ctx
= cp
->ulp_handle
[if_type
];
2677 ulp_ops
->indicate_netevent(ctx
, event
);
2681 if (event
== NETDEV_GOING_DOWN
) {
2682 mutex_lock(&cnic_lock
);
2685 mutex_unlock(&cnic_lock
);
2686 } else if (event
== NETDEV_UNREGISTER
) {
2687 write_lock(&cnic_dev_lock
);
2688 list_del_init(&dev
->list
);
2689 write_unlock(&cnic_dev_lock
);
2701 static struct notifier_block cnic_netdev_notifier
= {
2702 .notifier_call
= cnic_netdev_event
2705 static void cnic_release(void)
2707 struct cnic_dev
*dev
;
2709 while (!list_empty(&cnic_dev_list
)) {
2710 dev
= list_entry(cnic_dev_list
.next
, struct cnic_dev
, list
);
2711 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)) {
2717 list_del_init(&dev
->list
);
2722 static int __init
cnic_init(void)
2726 printk(KERN_INFO
"%s", version
);
2728 rc
= register_netdevice_notifier(&cnic_netdev_notifier
);
2737 static void __exit
cnic_exit(void)
2739 unregister_netdevice_notifier(&cnic_netdev_notifier
);
2744 module_init(cnic_init
);
2745 module_exit(cnic_exit
);