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 #include <linux/module.h>
30 #if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)
35 #include <net/route.h>
37 #include <net/ip6_route.h>
38 #include <scsi/iscsi_if.h>
43 #include "cnic_defs.h"
45 #define DRV_MODULE_NAME "cnic"
46 #define PFX DRV_MODULE_NAME ": "
48 static char version
[] __devinitdata
=
49 "Broadcom NetXtreme II CNIC Driver " DRV_MODULE_NAME
" v" CNIC_MODULE_VERSION
" (" CNIC_MODULE_RELDATE
")\n";
51 MODULE_AUTHOR("Michael Chan <mchan@broadcom.com> and John(Zongxi) "
52 "Chen (zongxi@broadcom.com");
53 MODULE_DESCRIPTION("Broadcom NetXtreme II CNIC Driver");
54 MODULE_LICENSE("GPL");
55 MODULE_VERSION(CNIC_MODULE_VERSION
);
57 static LIST_HEAD(cnic_dev_list
);
58 static DEFINE_RWLOCK(cnic_dev_lock
);
59 static DEFINE_MUTEX(cnic_lock
);
61 static struct cnic_ulp_ops
*cnic_ulp_tbl
[MAX_CNIC_ULP_TYPE
];
63 static int cnic_service_bnx2(void *, void *);
64 static int cnic_ctl(void *, struct cnic_ctl_info
*);
66 static struct cnic_ops cnic_bnx2_ops
= {
67 .cnic_owner
= THIS_MODULE
,
68 .cnic_handler
= cnic_service_bnx2
,
72 static void cnic_shutdown_bnx2_rx_ring(struct cnic_dev
*);
73 static void cnic_init_bnx2_tx_ring(struct cnic_dev
*);
74 static void cnic_init_bnx2_rx_ring(struct cnic_dev
*);
75 static int cnic_cm_set_pg(struct cnic_sock
*);
77 static int cnic_uio_open(struct uio_info
*uinfo
, struct inode
*inode
)
79 struct cnic_dev
*dev
= uinfo
->priv
;
80 struct cnic_local
*cp
= dev
->cnic_priv
;
82 if (!capable(CAP_NET_ADMIN
))
85 if (cp
->uio_dev
!= -1)
88 cp
->uio_dev
= iminor(inode
);
90 cnic_shutdown_bnx2_rx_ring(dev
);
92 cnic_init_bnx2_tx_ring(dev
);
93 cnic_init_bnx2_rx_ring(dev
);
98 static int cnic_uio_close(struct uio_info
*uinfo
, struct inode
*inode
)
100 struct cnic_dev
*dev
= uinfo
->priv
;
101 struct cnic_local
*cp
= dev
->cnic_priv
;
107 static inline void cnic_hold(struct cnic_dev
*dev
)
109 atomic_inc(&dev
->ref_count
);
112 static inline void cnic_put(struct cnic_dev
*dev
)
114 atomic_dec(&dev
->ref_count
);
117 static inline void csk_hold(struct cnic_sock
*csk
)
119 atomic_inc(&csk
->ref_count
);
122 static inline void csk_put(struct cnic_sock
*csk
)
124 atomic_dec(&csk
->ref_count
);
127 static struct cnic_dev
*cnic_from_netdev(struct net_device
*netdev
)
129 struct cnic_dev
*cdev
;
131 read_lock(&cnic_dev_lock
);
132 list_for_each_entry(cdev
, &cnic_dev_list
, list
) {
133 if (netdev
== cdev
->netdev
) {
135 read_unlock(&cnic_dev_lock
);
139 read_unlock(&cnic_dev_lock
);
143 static void cnic_ctx_wr(struct cnic_dev
*dev
, u32 cid_addr
, u32 off
, u32 val
)
145 struct cnic_local
*cp
= dev
->cnic_priv
;
146 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
147 struct drv_ctl_info info
;
148 struct drv_ctl_io
*io
= &info
.data
.io
;
150 info
.cmd
= DRV_CTL_CTX_WR_CMD
;
151 io
->cid_addr
= cid_addr
;
154 ethdev
->drv_ctl(dev
->netdev
, &info
);
157 static void cnic_reg_wr_ind(struct cnic_dev
*dev
, u32 off
, u32 val
)
159 struct cnic_local
*cp
= dev
->cnic_priv
;
160 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
161 struct drv_ctl_info info
;
162 struct drv_ctl_io
*io
= &info
.data
.io
;
164 info
.cmd
= DRV_CTL_IO_WR_CMD
;
167 ethdev
->drv_ctl(dev
->netdev
, &info
);
170 static u32
cnic_reg_rd_ind(struct cnic_dev
*dev
, u32 off
)
172 struct cnic_local
*cp
= dev
->cnic_priv
;
173 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
174 struct drv_ctl_info info
;
175 struct drv_ctl_io
*io
= &info
.data
.io
;
177 info
.cmd
= DRV_CTL_IO_RD_CMD
;
179 ethdev
->drv_ctl(dev
->netdev
, &info
);
183 static int cnic_in_use(struct cnic_sock
*csk
)
185 return test_bit(SK_F_INUSE
, &csk
->flags
);
188 static void cnic_kwq_completion(struct cnic_dev
*dev
, u32 count
)
190 struct cnic_local
*cp
= dev
->cnic_priv
;
191 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
192 struct drv_ctl_info info
;
194 info
.cmd
= DRV_CTL_COMPLETION_CMD
;
195 info
.data
.comp
.comp_count
= count
;
196 ethdev
->drv_ctl(dev
->netdev
, &info
);
199 static int cnic_send_nlmsg(struct cnic_local
*cp
, u32 type
,
200 struct cnic_sock
*csk
)
202 struct iscsi_path path_req
;
205 u32 msg_type
= ISCSI_KEVENT_IF_DOWN
;
206 struct cnic_ulp_ops
*ulp_ops
;
208 if (cp
->uio_dev
== -1)
212 len
= sizeof(path_req
);
213 buf
= (char *) &path_req
;
214 memset(&path_req
, 0, len
);
216 msg_type
= ISCSI_KEVENT_PATH_REQ
;
217 path_req
.handle
= (u64
) csk
->l5_cid
;
218 if (test_bit(SK_F_IPV6
, &csk
->flags
)) {
219 memcpy(&path_req
.dst
.v6_addr
, &csk
->dst_ip
[0],
220 sizeof(struct in6_addr
));
221 path_req
.ip_addr_len
= 16;
223 memcpy(&path_req
.dst
.v4_addr
, &csk
->dst_ip
[0],
224 sizeof(struct in_addr
));
225 path_req
.ip_addr_len
= 4;
227 path_req
.vlan_id
= csk
->vlan_id
;
228 path_req
.pmtu
= csk
->mtu
;
232 ulp_ops
= rcu_dereference(cp
->ulp_ops
[CNIC_ULP_ISCSI
]);
234 ulp_ops
->iscsi_nl_send_msg(cp
->dev
, msg_type
, buf
, len
);
239 static int cnic_iscsi_nl_msg_recv(struct cnic_dev
*dev
, u32 msg_type
,
245 case ISCSI_UEVENT_PATH_UPDATE
: {
246 struct cnic_local
*cp
;
248 struct cnic_sock
*csk
;
249 struct iscsi_path
*path_resp
;
251 if (len
< sizeof(*path_resp
))
254 path_resp
= (struct iscsi_path
*) buf
;
256 l5_cid
= (u32
) path_resp
->handle
;
257 if (l5_cid
>= MAX_CM_SK_TBL_SZ
)
260 csk
= &cp
->csk_tbl
[l5_cid
];
262 if (cnic_in_use(csk
)) {
263 memcpy(csk
->ha
, path_resp
->mac_addr
, 6);
264 if (test_bit(SK_F_IPV6
, &csk
->flags
))
265 memcpy(&csk
->src_ip
[0], &path_resp
->src
.v6_addr
,
266 sizeof(struct in6_addr
));
268 memcpy(&csk
->src_ip
[0], &path_resp
->src
.v4_addr
,
269 sizeof(struct in_addr
));
270 if (is_valid_ether_addr(csk
->ha
))
281 static int cnic_offld_prep(struct cnic_sock
*csk
)
283 if (test_and_set_bit(SK_F_OFFLD_SCHED
, &csk
->flags
))
286 if (!test_bit(SK_F_CONNECT_START
, &csk
->flags
)) {
287 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
294 static int cnic_close_prep(struct cnic_sock
*csk
)
296 clear_bit(SK_F_CONNECT_START
, &csk
->flags
);
297 smp_mb__after_clear_bit();
299 if (test_and_clear_bit(SK_F_OFFLD_COMPLETE
, &csk
->flags
)) {
300 while (test_and_set_bit(SK_F_OFFLD_SCHED
, &csk
->flags
))
308 static int cnic_abort_prep(struct cnic_sock
*csk
)
310 clear_bit(SK_F_CONNECT_START
, &csk
->flags
);
311 smp_mb__after_clear_bit();
313 while (test_and_set_bit(SK_F_OFFLD_SCHED
, &csk
->flags
))
316 if (test_and_clear_bit(SK_F_OFFLD_COMPLETE
, &csk
->flags
)) {
317 csk
->state
= L4_KCQE_OPCODE_VALUE_RESET_COMP
;
324 int cnic_register_driver(int ulp_type
, struct cnic_ulp_ops
*ulp_ops
)
326 struct cnic_dev
*dev
;
328 if (ulp_type
>= MAX_CNIC_ULP_TYPE
) {
329 printk(KERN_ERR PFX
"cnic_register_driver: Bad type %d\n",
333 mutex_lock(&cnic_lock
);
334 if (cnic_ulp_tbl
[ulp_type
]) {
335 printk(KERN_ERR PFX
"cnic_register_driver: Type %d has already "
336 "been registered\n", ulp_type
);
337 mutex_unlock(&cnic_lock
);
341 read_lock(&cnic_dev_lock
);
342 list_for_each_entry(dev
, &cnic_dev_list
, list
) {
343 struct cnic_local
*cp
= dev
->cnic_priv
;
345 clear_bit(ULP_F_INIT
, &cp
->ulp_flags
[ulp_type
]);
347 read_unlock(&cnic_dev_lock
);
349 rcu_assign_pointer(cnic_ulp_tbl
[ulp_type
], ulp_ops
);
350 mutex_unlock(&cnic_lock
);
352 /* Prevent race conditions with netdev_event */
354 read_lock(&cnic_dev_lock
);
355 list_for_each_entry(dev
, &cnic_dev_list
, list
) {
356 struct cnic_local
*cp
= dev
->cnic_priv
;
358 if (!test_and_set_bit(ULP_F_INIT
, &cp
->ulp_flags
[ulp_type
]))
359 ulp_ops
->cnic_init(dev
);
361 read_unlock(&cnic_dev_lock
);
367 int cnic_unregister_driver(int ulp_type
)
369 struct cnic_dev
*dev
;
371 if (ulp_type
>= MAX_CNIC_ULP_TYPE
) {
372 printk(KERN_ERR PFX
"cnic_unregister_driver: Bad type %d\n",
376 mutex_lock(&cnic_lock
);
377 if (!cnic_ulp_tbl
[ulp_type
]) {
378 printk(KERN_ERR PFX
"cnic_unregister_driver: Type %d has not "
379 "been registered\n", ulp_type
);
382 read_lock(&cnic_dev_lock
);
383 list_for_each_entry(dev
, &cnic_dev_list
, list
) {
384 struct cnic_local
*cp
= dev
->cnic_priv
;
386 if (rcu_dereference(cp
->ulp_ops
[ulp_type
])) {
387 printk(KERN_ERR PFX
"cnic_unregister_driver: Type %d "
388 "still has devices registered\n", ulp_type
);
389 read_unlock(&cnic_dev_lock
);
393 read_unlock(&cnic_dev_lock
);
395 rcu_assign_pointer(cnic_ulp_tbl
[ulp_type
], NULL
);
397 mutex_unlock(&cnic_lock
);
402 mutex_unlock(&cnic_lock
);
406 static int cnic_start_hw(struct cnic_dev
*);
407 static void cnic_stop_hw(struct cnic_dev
*);
409 static int cnic_register_device(struct cnic_dev
*dev
, int ulp_type
,
412 struct cnic_local
*cp
= dev
->cnic_priv
;
413 struct cnic_ulp_ops
*ulp_ops
;
415 if (ulp_type
>= MAX_CNIC_ULP_TYPE
) {
416 printk(KERN_ERR PFX
"cnic_register_device: Bad type %d\n",
420 mutex_lock(&cnic_lock
);
421 if (cnic_ulp_tbl
[ulp_type
] == NULL
) {
422 printk(KERN_ERR PFX
"cnic_register_device: Driver with type %d "
423 "has not been registered\n", ulp_type
);
424 mutex_unlock(&cnic_lock
);
427 if (rcu_dereference(cp
->ulp_ops
[ulp_type
])) {
428 printk(KERN_ERR PFX
"cnic_register_device: Type %d has already "
429 "been registered to this device\n", ulp_type
);
430 mutex_unlock(&cnic_lock
);
434 clear_bit(ULP_F_START
, &cp
->ulp_flags
[ulp_type
]);
435 cp
->ulp_handle
[ulp_type
] = ulp_ctx
;
436 ulp_ops
= cnic_ulp_tbl
[ulp_type
];
437 rcu_assign_pointer(cp
->ulp_ops
[ulp_type
], ulp_ops
);
440 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
))
441 if (!test_and_set_bit(ULP_F_START
, &cp
->ulp_flags
[ulp_type
]))
442 ulp_ops
->cnic_start(cp
->ulp_handle
[ulp_type
]);
444 mutex_unlock(&cnic_lock
);
449 EXPORT_SYMBOL(cnic_register_driver
);
451 static int cnic_unregister_device(struct cnic_dev
*dev
, int ulp_type
)
453 struct cnic_local
*cp
= dev
->cnic_priv
;
455 if (ulp_type
>= MAX_CNIC_ULP_TYPE
) {
456 printk(KERN_ERR PFX
"cnic_unregister_device: Bad type %d\n",
460 mutex_lock(&cnic_lock
);
461 if (rcu_dereference(cp
->ulp_ops
[ulp_type
])) {
462 rcu_assign_pointer(cp
->ulp_ops
[ulp_type
], NULL
);
465 printk(KERN_ERR PFX
"cnic_unregister_device: device not "
466 "registered to this ulp type %d\n", ulp_type
);
467 mutex_unlock(&cnic_lock
);
470 mutex_unlock(&cnic_lock
);
476 EXPORT_SYMBOL(cnic_unregister_driver
);
478 static int cnic_init_id_tbl(struct cnic_id_tbl
*id_tbl
, u32 size
, u32 start_id
)
480 id_tbl
->start
= start_id
;
483 spin_lock_init(&id_tbl
->lock
);
484 id_tbl
->table
= kzalloc(DIV_ROUND_UP(size
, 32) * 4, GFP_KERNEL
);
491 static void cnic_free_id_tbl(struct cnic_id_tbl
*id_tbl
)
493 kfree(id_tbl
->table
);
494 id_tbl
->table
= NULL
;
497 static int cnic_alloc_id(struct cnic_id_tbl
*id_tbl
, u32 id
)
502 if (id
>= id_tbl
->max
)
505 spin_lock(&id_tbl
->lock
);
506 if (!test_bit(id
, id_tbl
->table
)) {
507 set_bit(id
, id_tbl
->table
);
510 spin_unlock(&id_tbl
->lock
);
514 /* Returns -1 if not successful */
515 static u32
cnic_alloc_new_id(struct cnic_id_tbl
*id_tbl
)
519 spin_lock(&id_tbl
->lock
);
520 id
= find_next_zero_bit(id_tbl
->table
, id_tbl
->max
, id_tbl
->next
);
521 if (id
>= id_tbl
->max
) {
523 if (id_tbl
->next
!= 0) {
524 id
= find_first_zero_bit(id_tbl
->table
, id_tbl
->next
);
525 if (id
>= id_tbl
->next
)
530 if (id
< id_tbl
->max
) {
531 set_bit(id
, id_tbl
->table
);
532 id_tbl
->next
= (id
+ 1) & (id_tbl
->max
- 1);
536 spin_unlock(&id_tbl
->lock
);
541 static void cnic_free_id(struct cnic_id_tbl
*id_tbl
, u32 id
)
547 if (id
>= id_tbl
->max
)
550 clear_bit(id
, id_tbl
->table
);
553 static void cnic_free_dma(struct cnic_dev
*dev
, struct cnic_dma
*dma
)
560 for (i
= 0; i
< dma
->num_pages
; i
++) {
561 if (dma
->pg_arr
[i
]) {
562 pci_free_consistent(dev
->pcidev
, BCM_PAGE_SIZE
,
563 dma
->pg_arr
[i
], dma
->pg_map_arr
[i
]);
564 dma
->pg_arr
[i
] = NULL
;
568 pci_free_consistent(dev
->pcidev
, dma
->pgtbl_size
,
569 dma
->pgtbl
, dma
->pgtbl_map
);
577 static void cnic_setup_page_tbl(struct cnic_dev
*dev
, struct cnic_dma
*dma
)
580 u32
*page_table
= dma
->pgtbl
;
582 for (i
= 0; i
< dma
->num_pages
; i
++) {
583 /* Each entry needs to be in big endian format. */
584 *page_table
= (u32
) ((u64
) dma
->pg_map_arr
[i
] >> 32);
586 *page_table
= (u32
) dma
->pg_map_arr
[i
];
591 static int cnic_alloc_dma(struct cnic_dev
*dev
, struct cnic_dma
*dma
,
592 int pages
, int use_pg_tbl
)
595 struct cnic_local
*cp
= dev
->cnic_priv
;
597 size
= pages
* (sizeof(void *) + sizeof(dma_addr_t
));
598 dma
->pg_arr
= kzalloc(size
, GFP_ATOMIC
);
599 if (dma
->pg_arr
== NULL
)
602 dma
->pg_map_arr
= (dma_addr_t
*) (dma
->pg_arr
+ pages
);
603 dma
->num_pages
= pages
;
605 for (i
= 0; i
< pages
; i
++) {
606 dma
->pg_arr
[i
] = pci_alloc_consistent(dev
->pcidev
,
608 &dma
->pg_map_arr
[i
]);
609 if (dma
->pg_arr
[i
] == NULL
)
615 dma
->pgtbl_size
= ((pages
* 8) + BCM_PAGE_SIZE
- 1) &
616 ~(BCM_PAGE_SIZE
- 1);
617 dma
->pgtbl
= pci_alloc_consistent(dev
->pcidev
, dma
->pgtbl_size
,
619 if (dma
->pgtbl
== NULL
)
622 cp
->setup_pgtbl(dev
, dma
);
627 cnic_free_dma(dev
, dma
);
631 static void cnic_free_resc(struct cnic_dev
*dev
)
633 struct cnic_local
*cp
= dev
->cnic_priv
;
636 if (cp
->cnic_uinfo
) {
637 cnic_send_nlmsg(cp
, ISCSI_KEVENT_IF_DOWN
, NULL
);
638 while (cp
->uio_dev
!= -1 && i
< 15) {
642 uio_unregister_device(cp
->cnic_uinfo
);
643 kfree(cp
->cnic_uinfo
);
644 cp
->cnic_uinfo
= NULL
;
648 pci_free_consistent(dev
->pcidev
, cp
->l2_buf_size
,
649 cp
->l2_buf
, cp
->l2_buf_map
);
654 pci_free_consistent(dev
->pcidev
, cp
->l2_ring_size
,
655 cp
->l2_ring
, cp
->l2_ring_map
);
659 for (i
= 0; i
< cp
->ctx_blks
; i
++) {
660 if (cp
->ctx_arr
[i
].ctx
) {
661 pci_free_consistent(dev
->pcidev
, cp
->ctx_blk_size
,
663 cp
->ctx_arr
[i
].mapping
);
664 cp
->ctx_arr
[i
].ctx
= NULL
;
671 cnic_free_dma(dev
, &cp
->gbl_buf_info
);
672 cnic_free_dma(dev
, &cp
->conn_buf_info
);
673 cnic_free_dma(dev
, &cp
->kwq_info
);
674 cnic_free_dma(dev
, &cp
->kcq_info
);
675 kfree(cp
->iscsi_tbl
);
676 cp
->iscsi_tbl
= NULL
;
680 cnic_free_id_tbl(&cp
->cid_tbl
);
683 static int cnic_alloc_context(struct cnic_dev
*dev
)
685 struct cnic_local
*cp
= dev
->cnic_priv
;
687 if (CHIP_NUM(cp
) == CHIP_NUM_5709
) {
690 cp
->ctx_blk_size
= BCM_PAGE_SIZE
;
691 cp
->cids_per_blk
= BCM_PAGE_SIZE
/ 128;
692 arr_size
= BNX2_MAX_CID
/ cp
->cids_per_blk
*
693 sizeof(struct cnic_ctx
);
694 cp
->ctx_arr
= kzalloc(arr_size
, GFP_KERNEL
);
695 if (cp
->ctx_arr
== NULL
)
699 for (i
= 0; i
< 2; i
++) {
700 u32 j
, reg
, off
, lo
, hi
;
703 off
= BNX2_PG_CTX_MAP
;
705 off
= BNX2_ISCSI_CTX_MAP
;
707 reg
= cnic_reg_rd_ind(dev
, off
);
710 for (j
= lo
; j
< hi
; j
+= cp
->cids_per_blk
, k
++)
711 cp
->ctx_arr
[k
].cid
= j
;
715 if (cp
->ctx_blks
>= (BNX2_MAX_CID
/ cp
->cids_per_blk
)) {
720 for (i
= 0; i
< cp
->ctx_blks
; i
++) {
722 pci_alloc_consistent(dev
->pcidev
, BCM_PAGE_SIZE
,
723 &cp
->ctx_arr
[i
].mapping
);
724 if (cp
->ctx_arr
[i
].ctx
== NULL
)
731 static int cnic_alloc_bnx2_resc(struct cnic_dev
*dev
)
733 struct cnic_local
*cp
= dev
->cnic_priv
;
734 struct uio_info
*uinfo
;
737 ret
= cnic_alloc_dma(dev
, &cp
->kwq_info
, KWQ_PAGE_CNT
, 1);
740 cp
->kwq
= (struct kwqe
**) cp
->kwq_info
.pg_arr
;
742 ret
= cnic_alloc_dma(dev
, &cp
->kcq_info
, KCQ_PAGE_CNT
, 1);
745 cp
->kcq
= (struct kcqe
**) cp
->kcq_info
.pg_arr
;
747 ret
= cnic_alloc_context(dev
);
751 cp
->l2_ring_size
= 2 * BCM_PAGE_SIZE
;
752 cp
->l2_ring
= pci_alloc_consistent(dev
->pcidev
, cp
->l2_ring_size
,
757 cp
->l2_buf_size
= (cp
->l2_rx_ring_size
+ 1) * cp
->l2_single_buf_size
;
758 cp
->l2_buf_size
= PAGE_ALIGN(cp
->l2_buf_size
);
759 cp
->l2_buf
= pci_alloc_consistent(dev
->pcidev
, cp
->l2_buf_size
,
764 uinfo
= kzalloc(sizeof(*uinfo
), GFP_ATOMIC
);
768 uinfo
->mem
[0].addr
= dev
->netdev
->base_addr
;
769 uinfo
->mem
[0].internal_addr
= dev
->regview
;
770 uinfo
->mem
[0].size
= dev
->netdev
->mem_end
- dev
->netdev
->mem_start
;
771 uinfo
->mem
[0].memtype
= UIO_MEM_PHYS
;
773 uinfo
->mem
[1].addr
= (unsigned long) cp
->status_blk
& PAGE_MASK
;
774 if (cp
->ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
)
775 uinfo
->mem
[1].size
= BNX2_SBLK_MSIX_ALIGN_SIZE
* 9;
777 uinfo
->mem
[1].size
= BNX2_SBLK_MSIX_ALIGN_SIZE
;
778 uinfo
->mem
[1].memtype
= UIO_MEM_LOGICAL
;
780 uinfo
->mem
[2].addr
= (unsigned long) cp
->l2_ring
;
781 uinfo
->mem
[2].size
= cp
->l2_ring_size
;
782 uinfo
->mem
[2].memtype
= UIO_MEM_LOGICAL
;
784 uinfo
->mem
[3].addr
= (unsigned long) cp
->l2_buf
;
785 uinfo
->mem
[3].size
= cp
->l2_buf_size
;
786 uinfo
->mem
[3].memtype
= UIO_MEM_LOGICAL
;
788 uinfo
->name
= "bnx2_cnic";
789 uinfo
->version
= CNIC_MODULE_VERSION
;
790 uinfo
->irq
= UIO_IRQ_CUSTOM
;
792 uinfo
->open
= cnic_uio_open
;
793 uinfo
->release
= cnic_uio_close
;
797 ret
= uio_register_device(&dev
->pcidev
->dev
, uinfo
);
803 cp
->cnic_uinfo
= uinfo
;
812 static inline u32
cnic_kwq_avail(struct cnic_local
*cp
)
814 return cp
->max_kwq_idx
-
815 ((cp
->kwq_prod_idx
- cp
->kwq_con_idx
) & cp
->max_kwq_idx
);
818 static int cnic_submit_bnx2_kwqes(struct cnic_dev
*dev
, struct kwqe
*wqes
[],
821 struct cnic_local
*cp
= dev
->cnic_priv
;
822 struct kwqe
*prod_qe
;
823 u16 prod
, sw_prod
, i
;
825 if (!test_bit(CNIC_F_CNIC_UP
, &dev
->flags
))
826 return -EAGAIN
; /* bnx2 is down */
828 spin_lock_bh(&cp
->cnic_ulp_lock
);
829 if (num_wqes
> cnic_kwq_avail(cp
) &&
830 !(cp
->cnic_local_flags
& CNIC_LCL_FL_KWQ_INIT
)) {
831 spin_unlock_bh(&cp
->cnic_ulp_lock
);
835 cp
->cnic_local_flags
&= ~CNIC_LCL_FL_KWQ_INIT
;
837 prod
= cp
->kwq_prod_idx
;
838 sw_prod
= prod
& MAX_KWQ_IDX
;
839 for (i
= 0; i
< num_wqes
; i
++) {
840 prod_qe
= &cp
->kwq
[KWQ_PG(sw_prod
)][KWQ_IDX(sw_prod
)];
841 memcpy(prod_qe
, wqes
[i
], sizeof(struct kwqe
));
843 sw_prod
= prod
& MAX_KWQ_IDX
;
845 cp
->kwq_prod_idx
= prod
;
847 CNIC_WR16(dev
, cp
->kwq_io_addr
, cp
->kwq_prod_idx
);
849 spin_unlock_bh(&cp
->cnic_ulp_lock
);
853 static void service_kcqes(struct cnic_dev
*dev
, int num_cqes
)
855 struct cnic_local
*cp
= dev
->cnic_priv
;
861 struct cnic_ulp_ops
*ulp_ops
;
863 u32 kcqe_op_flag
= cp
->completed_kcq
[i
]->kcqe_op_flag
;
864 u32 kcqe_layer
= kcqe_op_flag
& KCQE_FLAGS_LAYER_MASK
;
866 if (unlikely(kcqe_op_flag
& KCQE_RAMROD_COMPLETION
))
867 cnic_kwq_completion(dev
, 1);
869 while (j
< num_cqes
) {
870 u32 next_op
= cp
->completed_kcq
[i
+ j
]->kcqe_op_flag
;
872 if ((next_op
& KCQE_FLAGS_LAYER_MASK
) != kcqe_layer
)
875 if (unlikely(next_op
& KCQE_RAMROD_COMPLETION
))
876 cnic_kwq_completion(dev
, 1);
880 if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L5_RDMA
)
881 ulp_type
= CNIC_ULP_RDMA
;
882 else if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L5_ISCSI
)
883 ulp_type
= CNIC_ULP_ISCSI
;
884 else if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L4
)
885 ulp_type
= CNIC_ULP_L4
;
886 else if (kcqe_layer
== KCQE_FLAGS_LAYER_MASK_L2
)
889 printk(KERN_ERR PFX
"%s: Unknown type of KCQE(0x%x)\n",
890 dev
->netdev
->name
, kcqe_op_flag
);
895 ulp_ops
= rcu_dereference(cp
->ulp_ops
[ulp_type
]);
896 if (likely(ulp_ops
)) {
897 ulp_ops
->indicate_kcqes(cp
->ulp_handle
[ulp_type
],
898 cp
->completed_kcq
+ i
, j
);
909 static u16
cnic_bnx2_next_idx(u16 idx
)
914 static u16
cnic_bnx2_hw_idx(u16 idx
)
919 static int cnic_get_kcqes(struct cnic_dev
*dev
, u16 hw_prod
, u16
*sw_prod
)
921 struct cnic_local
*cp
= dev
->cnic_priv
;
924 int kcqe_cnt
= 0, last_cnt
= 0;
926 i
= ri
= last
= *sw_prod
;
929 while ((i
!= hw_prod
) && (kcqe_cnt
< MAX_COMPLETED_KCQE
)) {
930 kcqe
= &cp
->kcq
[KCQ_PG(ri
)][KCQ_IDX(ri
)];
931 cp
->completed_kcq
[kcqe_cnt
++] = kcqe
;
933 ri
= i
& MAX_KCQ_IDX
;
934 if (likely(!(kcqe
->kcqe_op_flag
& KCQE_FLAGS_NEXT
))) {
944 static void cnic_chk_bnx2_pkt_rings(struct cnic_local
*cp
)
946 u16 rx_cons
= *cp
->rx_cons_ptr
;
947 u16 tx_cons
= *cp
->tx_cons_ptr
;
949 if (cp
->tx_cons
!= tx_cons
|| cp
->rx_cons
!= rx_cons
) {
950 cp
->tx_cons
= tx_cons
;
951 cp
->rx_cons
= rx_cons
;
952 uio_event_notify(cp
->cnic_uinfo
);
956 static int cnic_service_bnx2(void *data
, void *status_blk
)
958 struct cnic_dev
*dev
= data
;
959 struct status_block
*sblk
= status_blk
;
960 struct cnic_local
*cp
= dev
->cnic_priv
;
961 u32 status_idx
= sblk
->status_idx
;
962 u16 hw_prod
, sw_prod
;
965 if (unlikely(!test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)))
968 cp
->kwq_con_idx
= *cp
->kwq_con_idx_ptr
;
970 hw_prod
= sblk
->status_completion_producer_index
;
971 sw_prod
= cp
->kcq_prod_idx
;
972 while (sw_prod
!= hw_prod
) {
973 kcqe_cnt
= cnic_get_kcqes(dev
, hw_prod
, &sw_prod
);
977 service_kcqes(dev
, kcqe_cnt
);
979 /* Tell compiler that status_blk fields can change. */
981 if (status_idx
!= sblk
->status_idx
) {
982 status_idx
= sblk
->status_idx
;
983 cp
->kwq_con_idx
= *cp
->kwq_con_idx_ptr
;
984 hw_prod
= sblk
->status_completion_producer_index
;
990 CNIC_WR16(dev
, cp
->kcq_io_addr
, sw_prod
);
992 cp
->kcq_prod_idx
= sw_prod
;
994 cnic_chk_bnx2_pkt_rings(cp
);
998 static void cnic_service_bnx2_msix(unsigned long data
)
1000 struct cnic_dev
*dev
= (struct cnic_dev
*) data
;
1001 struct cnic_local
*cp
= dev
->cnic_priv
;
1002 struct status_block_msix
*status_blk
= cp
->bnx2_status_blk
;
1003 u32 status_idx
= status_blk
->status_idx
;
1004 u16 hw_prod
, sw_prod
;
1007 cp
->kwq_con_idx
= status_blk
->status_cmd_consumer_index
;
1009 hw_prod
= status_blk
->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
!= status_blk
->status_idx
) {
1021 status_idx
= status_blk
->status_idx
;
1022 cp
->kwq_con_idx
= status_blk
->status_cmd_consumer_index
;
1023 hw_prod
= status_blk
->status_completion_producer_index
;
1029 CNIC_WR16(dev
, cp
->kcq_io_addr
, sw_prod
);
1030 cp
->kcq_prod_idx
= sw_prod
;
1032 cnic_chk_bnx2_pkt_rings(cp
);
1034 cp
->last_status_idx
= status_idx
;
1035 CNIC_WR(dev
, BNX2_PCICFG_INT_ACK_CMD
, cp
->int_num
|
1036 BNX2_PCICFG_INT_ACK_CMD_INDEX_VALID
| cp
->last_status_idx
);
1039 static irqreturn_t
cnic_irq(int irq
, void *dev_instance
)
1041 struct cnic_dev
*dev
= dev_instance
;
1042 struct cnic_local
*cp
= dev
->cnic_priv
;
1043 u16 prod
= cp
->kcq_prod_idx
& MAX_KCQ_IDX
;
1048 prefetch(cp
->status_blk
);
1049 prefetch(&cp
->kcq
[KCQ_PG(prod
)][KCQ_IDX(prod
)]);
1051 if (likely(test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)))
1052 tasklet_schedule(&cp
->cnic_irq_task
);
1057 static void cnic_ulp_stop(struct cnic_dev
*dev
)
1059 struct cnic_local
*cp
= dev
->cnic_priv
;
1063 for (if_type
= 0; if_type
< MAX_CNIC_ULP_TYPE
; if_type
++) {
1064 struct cnic_ulp_ops
*ulp_ops
;
1066 ulp_ops
= rcu_dereference(cp
->ulp_ops
[if_type
]);
1070 if (test_and_clear_bit(ULP_F_START
, &cp
->ulp_flags
[if_type
]))
1071 ulp_ops
->cnic_stop(cp
->ulp_handle
[if_type
]);
1076 static void cnic_ulp_start(struct cnic_dev
*dev
)
1078 struct cnic_local
*cp
= dev
->cnic_priv
;
1082 for (if_type
= 0; if_type
< MAX_CNIC_ULP_TYPE
; if_type
++) {
1083 struct cnic_ulp_ops
*ulp_ops
;
1085 ulp_ops
= rcu_dereference(cp
->ulp_ops
[if_type
]);
1086 if (!ulp_ops
|| !ulp_ops
->cnic_start
)
1089 if (!test_and_set_bit(ULP_F_START
, &cp
->ulp_flags
[if_type
]))
1090 ulp_ops
->cnic_start(cp
->ulp_handle
[if_type
]);
1095 static int cnic_ctl(void *data
, struct cnic_ctl_info
*info
)
1097 struct cnic_dev
*dev
= data
;
1099 switch (info
->cmd
) {
1100 case CNIC_CTL_STOP_CMD
:
1102 mutex_lock(&cnic_lock
);
1107 mutex_unlock(&cnic_lock
);
1110 case CNIC_CTL_START_CMD
:
1112 mutex_lock(&cnic_lock
);
1114 if (!cnic_start_hw(dev
))
1115 cnic_ulp_start(dev
);
1117 mutex_unlock(&cnic_lock
);
1126 static void cnic_ulp_init(struct cnic_dev
*dev
)
1129 struct cnic_local
*cp
= dev
->cnic_priv
;
1132 for (i
= 0; i
< MAX_CNIC_ULP_TYPE_EXT
; i
++) {
1133 struct cnic_ulp_ops
*ulp_ops
;
1135 ulp_ops
= rcu_dereference(cnic_ulp_tbl
[i
]);
1136 if (!ulp_ops
|| !ulp_ops
->cnic_init
)
1139 if (!test_and_set_bit(ULP_F_INIT
, &cp
->ulp_flags
[i
]))
1140 ulp_ops
->cnic_init(dev
);
1146 static void cnic_ulp_exit(struct cnic_dev
*dev
)
1149 struct cnic_local
*cp
= dev
->cnic_priv
;
1152 for (i
= 0; i
< MAX_CNIC_ULP_TYPE_EXT
; i
++) {
1153 struct cnic_ulp_ops
*ulp_ops
;
1155 ulp_ops
= rcu_dereference(cnic_ulp_tbl
[i
]);
1156 if (!ulp_ops
|| !ulp_ops
->cnic_exit
)
1159 if (test_and_clear_bit(ULP_F_INIT
, &cp
->ulp_flags
[i
]))
1160 ulp_ops
->cnic_exit(dev
);
1166 static int cnic_cm_offload_pg(struct cnic_sock
*csk
)
1168 struct cnic_dev
*dev
= csk
->dev
;
1169 struct l4_kwq_offload_pg
*l4kwqe
;
1170 struct kwqe
*wqes
[1];
1172 l4kwqe
= (struct l4_kwq_offload_pg
*) &csk
->kwqe1
;
1173 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1174 wqes
[0] = (struct kwqe
*) l4kwqe
;
1176 l4kwqe
->op_code
= L4_KWQE_OPCODE_VALUE_OFFLOAD_PG
;
1178 L4_LAYER_CODE
<< L4_KWQ_OFFLOAD_PG_LAYER_CODE_SHIFT
;
1179 l4kwqe
->l2hdr_nbytes
= ETH_HLEN
;
1181 l4kwqe
->da0
= csk
->ha
[0];
1182 l4kwqe
->da1
= csk
->ha
[1];
1183 l4kwqe
->da2
= csk
->ha
[2];
1184 l4kwqe
->da3
= csk
->ha
[3];
1185 l4kwqe
->da4
= csk
->ha
[4];
1186 l4kwqe
->da5
= csk
->ha
[5];
1188 l4kwqe
->sa0
= dev
->mac_addr
[0];
1189 l4kwqe
->sa1
= dev
->mac_addr
[1];
1190 l4kwqe
->sa2
= dev
->mac_addr
[2];
1191 l4kwqe
->sa3
= dev
->mac_addr
[3];
1192 l4kwqe
->sa4
= dev
->mac_addr
[4];
1193 l4kwqe
->sa5
= dev
->mac_addr
[5];
1195 l4kwqe
->etype
= ETH_P_IP
;
1196 l4kwqe
->ipid_count
= DEF_IPID_COUNT
;
1197 l4kwqe
->host_opaque
= csk
->l5_cid
;
1200 l4kwqe
->pg_flags
|= L4_KWQ_OFFLOAD_PG_VLAN_TAGGING
;
1201 l4kwqe
->vlan_tag
= csk
->vlan_id
;
1202 l4kwqe
->l2hdr_nbytes
+= 4;
1205 return dev
->submit_kwqes(dev
, wqes
, 1);
1208 static int cnic_cm_update_pg(struct cnic_sock
*csk
)
1210 struct cnic_dev
*dev
= csk
->dev
;
1211 struct l4_kwq_update_pg
*l4kwqe
;
1212 struct kwqe
*wqes
[1];
1214 l4kwqe
= (struct l4_kwq_update_pg
*) &csk
->kwqe1
;
1215 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1216 wqes
[0] = (struct kwqe
*) l4kwqe
;
1218 l4kwqe
->opcode
= L4_KWQE_OPCODE_VALUE_UPDATE_PG
;
1220 L4_LAYER_CODE
<< L4_KWQ_UPDATE_PG_LAYER_CODE_SHIFT
;
1221 l4kwqe
->pg_cid
= csk
->pg_cid
;
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
->pg_host_opaque
= csk
->l5_cid
;
1231 l4kwqe
->pg_valids
= L4_KWQ_UPDATE_PG_VALIDS_DA
;
1233 return dev
->submit_kwqes(dev
, wqes
, 1);
1236 static int cnic_cm_upload_pg(struct cnic_sock
*csk
)
1238 struct cnic_dev
*dev
= csk
->dev
;
1239 struct l4_kwq_upload
*l4kwqe
;
1240 struct kwqe
*wqes
[1];
1242 l4kwqe
= (struct l4_kwq_upload
*) &csk
->kwqe1
;
1243 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1244 wqes
[0] = (struct kwqe
*) l4kwqe
;
1246 l4kwqe
->opcode
= L4_KWQE_OPCODE_VALUE_UPLOAD_PG
;
1248 L4_LAYER_CODE
<< L4_KWQ_UPLOAD_LAYER_CODE_SHIFT
;
1249 l4kwqe
->cid
= csk
->pg_cid
;
1251 return dev
->submit_kwqes(dev
, wqes
, 1);
1254 static int cnic_cm_conn_req(struct cnic_sock
*csk
)
1256 struct cnic_dev
*dev
= csk
->dev
;
1257 struct l4_kwq_connect_req1
*l4kwqe1
;
1258 struct l4_kwq_connect_req2
*l4kwqe2
;
1259 struct l4_kwq_connect_req3
*l4kwqe3
;
1260 struct kwqe
*wqes
[3];
1264 l4kwqe1
= (struct l4_kwq_connect_req1
*) &csk
->kwqe1
;
1265 l4kwqe2
= (struct l4_kwq_connect_req2
*) &csk
->kwqe2
;
1266 l4kwqe3
= (struct l4_kwq_connect_req3
*) &csk
->kwqe3
;
1267 memset(l4kwqe1
, 0, sizeof(*l4kwqe1
));
1268 memset(l4kwqe2
, 0, sizeof(*l4kwqe2
));
1269 memset(l4kwqe3
, 0, sizeof(*l4kwqe3
));
1271 l4kwqe3
->op_code
= L4_KWQE_OPCODE_VALUE_CONNECT3
;
1273 L4_LAYER_CODE
<< L4_KWQ_CONNECT_REQ3_LAYER_CODE_SHIFT
;
1274 l4kwqe3
->ka_timeout
= csk
->ka_timeout
;
1275 l4kwqe3
->ka_interval
= csk
->ka_interval
;
1276 l4kwqe3
->ka_max_probe_count
= csk
->ka_max_probe_count
;
1277 l4kwqe3
->tos
= csk
->tos
;
1278 l4kwqe3
->ttl
= csk
->ttl
;
1279 l4kwqe3
->snd_seq_scale
= csk
->snd_seq_scale
;
1280 l4kwqe3
->pmtu
= csk
->mtu
;
1281 l4kwqe3
->rcv_buf
= csk
->rcv_buf
;
1282 l4kwqe3
->snd_buf
= csk
->snd_buf
;
1283 l4kwqe3
->seed
= csk
->seed
;
1285 wqes
[0] = (struct kwqe
*) l4kwqe1
;
1286 if (test_bit(SK_F_IPV6
, &csk
->flags
)) {
1287 wqes
[1] = (struct kwqe
*) l4kwqe2
;
1288 wqes
[2] = (struct kwqe
*) l4kwqe3
;
1291 l4kwqe1
->conn_flags
= L4_KWQ_CONNECT_REQ1_IP_V6
;
1292 l4kwqe2
->op_code
= L4_KWQE_OPCODE_VALUE_CONNECT2
;
1294 L4_KWQ_CONNECT_REQ2_LINKED_WITH_NEXT
|
1295 L4_LAYER_CODE
<< L4_KWQ_CONNECT_REQ2_LAYER_CODE_SHIFT
;
1296 l4kwqe2
->src_ip_v6_2
= be32_to_cpu(csk
->src_ip
[1]);
1297 l4kwqe2
->src_ip_v6_3
= be32_to_cpu(csk
->src_ip
[2]);
1298 l4kwqe2
->src_ip_v6_4
= be32_to_cpu(csk
->src_ip
[3]);
1299 l4kwqe2
->dst_ip_v6_2
= be32_to_cpu(csk
->dst_ip
[1]);
1300 l4kwqe2
->dst_ip_v6_3
= be32_to_cpu(csk
->dst_ip
[2]);
1301 l4kwqe2
->dst_ip_v6_4
= be32_to_cpu(csk
->dst_ip
[3]);
1302 l4kwqe3
->mss
= l4kwqe3
->pmtu
- sizeof(struct ipv6hdr
) -
1303 sizeof(struct tcphdr
);
1305 wqes
[1] = (struct kwqe
*) l4kwqe3
;
1306 l4kwqe3
->mss
= l4kwqe3
->pmtu
- sizeof(struct iphdr
) -
1307 sizeof(struct tcphdr
);
1310 l4kwqe1
->op_code
= L4_KWQE_OPCODE_VALUE_CONNECT1
;
1312 (L4_LAYER_CODE
<< L4_KWQ_CONNECT_REQ1_LAYER_CODE_SHIFT
) |
1313 L4_KWQ_CONNECT_REQ3_LINKED_WITH_NEXT
;
1314 l4kwqe1
->cid
= csk
->cid
;
1315 l4kwqe1
->pg_cid
= csk
->pg_cid
;
1316 l4kwqe1
->src_ip
= be32_to_cpu(csk
->src_ip
[0]);
1317 l4kwqe1
->dst_ip
= be32_to_cpu(csk
->dst_ip
[0]);
1318 l4kwqe1
->src_port
= be16_to_cpu(csk
->src_port
);
1319 l4kwqe1
->dst_port
= be16_to_cpu(csk
->dst_port
);
1320 if (csk
->tcp_flags
& SK_TCP_NO_DELAY_ACK
)
1321 tcp_flags
|= L4_KWQ_CONNECT_REQ1_NO_DELAY_ACK
;
1322 if (csk
->tcp_flags
& SK_TCP_KEEP_ALIVE
)
1323 tcp_flags
|= L4_KWQ_CONNECT_REQ1_KEEP_ALIVE
;
1324 if (csk
->tcp_flags
& SK_TCP_NAGLE
)
1325 tcp_flags
|= L4_KWQ_CONNECT_REQ1_NAGLE_ENABLE
;
1326 if (csk
->tcp_flags
& SK_TCP_TIMESTAMP
)
1327 tcp_flags
|= L4_KWQ_CONNECT_REQ1_TIME_STAMP
;
1328 if (csk
->tcp_flags
& SK_TCP_SACK
)
1329 tcp_flags
|= L4_KWQ_CONNECT_REQ1_SACK
;
1330 if (csk
->tcp_flags
& SK_TCP_SEG_SCALING
)
1331 tcp_flags
|= L4_KWQ_CONNECT_REQ1_SEG_SCALING
;
1333 l4kwqe1
->tcp_flags
= tcp_flags
;
1335 return dev
->submit_kwqes(dev
, wqes
, num_wqes
);
1338 static int cnic_cm_close_req(struct cnic_sock
*csk
)
1340 struct cnic_dev
*dev
= csk
->dev
;
1341 struct l4_kwq_close_req
*l4kwqe
;
1342 struct kwqe
*wqes
[1];
1344 l4kwqe
= (struct l4_kwq_close_req
*) &csk
->kwqe2
;
1345 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1346 wqes
[0] = (struct kwqe
*) l4kwqe
;
1348 l4kwqe
->op_code
= L4_KWQE_OPCODE_VALUE_CLOSE
;
1349 l4kwqe
->flags
= L4_LAYER_CODE
<< L4_KWQ_CLOSE_REQ_LAYER_CODE_SHIFT
;
1350 l4kwqe
->cid
= csk
->cid
;
1352 return dev
->submit_kwqes(dev
, wqes
, 1);
1355 static int cnic_cm_abort_req(struct cnic_sock
*csk
)
1357 struct cnic_dev
*dev
= csk
->dev
;
1358 struct l4_kwq_reset_req
*l4kwqe
;
1359 struct kwqe
*wqes
[1];
1361 l4kwqe
= (struct l4_kwq_reset_req
*) &csk
->kwqe2
;
1362 memset(l4kwqe
, 0, sizeof(*l4kwqe
));
1363 wqes
[0] = (struct kwqe
*) l4kwqe
;
1365 l4kwqe
->op_code
= L4_KWQE_OPCODE_VALUE_RESET
;
1366 l4kwqe
->flags
= L4_LAYER_CODE
<< L4_KWQ_RESET_REQ_LAYER_CODE_SHIFT
;
1367 l4kwqe
->cid
= csk
->cid
;
1369 return dev
->submit_kwqes(dev
, wqes
, 1);
1372 static int cnic_cm_create(struct cnic_dev
*dev
, int ulp_type
, u32 cid
,
1373 u32 l5_cid
, struct cnic_sock
**csk
, void *context
)
1375 struct cnic_local
*cp
= dev
->cnic_priv
;
1376 struct cnic_sock
*csk1
;
1378 if (l5_cid
>= MAX_CM_SK_TBL_SZ
)
1381 csk1
= &cp
->csk_tbl
[l5_cid
];
1382 if (atomic_read(&csk1
->ref_count
))
1385 if (test_and_set_bit(SK_F_INUSE
, &csk1
->flags
))
1390 csk1
->l5_cid
= l5_cid
;
1391 csk1
->ulp_type
= ulp_type
;
1392 csk1
->context
= context
;
1394 csk1
->ka_timeout
= DEF_KA_TIMEOUT
;
1395 csk1
->ka_interval
= DEF_KA_INTERVAL
;
1396 csk1
->ka_max_probe_count
= DEF_KA_MAX_PROBE_COUNT
;
1397 csk1
->tos
= DEF_TOS
;
1398 csk1
->ttl
= DEF_TTL
;
1399 csk1
->snd_seq_scale
= DEF_SND_SEQ_SCALE
;
1400 csk1
->rcv_buf
= DEF_RCV_BUF
;
1401 csk1
->snd_buf
= DEF_SND_BUF
;
1402 csk1
->seed
= DEF_SEED
;
1408 static void cnic_cm_cleanup(struct cnic_sock
*csk
)
1410 if (csk
->src_port
) {
1411 struct cnic_dev
*dev
= csk
->dev
;
1412 struct cnic_local
*cp
= dev
->cnic_priv
;
1414 cnic_free_id(&cp
->csk_port_tbl
, csk
->src_port
);
1419 static void cnic_close_conn(struct cnic_sock
*csk
)
1421 if (test_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
)) {
1422 cnic_cm_upload_pg(csk
);
1423 clear_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
);
1425 cnic_cm_cleanup(csk
);
1428 static int cnic_cm_destroy(struct cnic_sock
*csk
)
1430 if (!cnic_in_use(csk
))
1434 clear_bit(SK_F_INUSE
, &csk
->flags
);
1435 smp_mb__after_clear_bit();
1436 while (atomic_read(&csk
->ref_count
) != 1)
1438 cnic_cm_cleanup(csk
);
1445 static inline u16
cnic_get_vlan(struct net_device
*dev
,
1446 struct net_device
**vlan_dev
)
1448 if (dev
->priv_flags
& IFF_802_1Q_VLAN
) {
1449 *vlan_dev
= vlan_dev_real_dev(dev
);
1450 return vlan_dev_vlan_id(dev
);
1456 static int cnic_get_v4_route(struct sockaddr_in
*dst_addr
,
1457 struct dst_entry
**dst
)
1459 #if defined(CONFIG_INET)
1464 memset(&fl
, 0, sizeof(fl
));
1465 fl
.nl_u
.ip4_u
.daddr
= dst_addr
->sin_addr
.s_addr
;
1467 err
= ip_route_output_key(&init_net
, &rt
, &fl
);
1472 return -ENETUNREACH
;
1476 static int cnic_get_v6_route(struct sockaddr_in6
*dst_addr
,
1477 struct dst_entry
**dst
)
1479 #if defined(CONFIG_IPV6) || (defined(CONFIG_IPV6_MODULE) && defined(MODULE))
1482 memset(&fl
, 0, sizeof(fl
));
1483 ipv6_addr_copy(&fl
.fl6_dst
, &dst_addr
->sin6_addr
);
1484 if (ipv6_addr_type(&fl
.fl6_dst
) & IPV6_ADDR_LINKLOCAL
)
1485 fl
.oif
= dst_addr
->sin6_scope_id
;
1487 *dst
= ip6_route_output(&init_net
, NULL
, &fl
);
1492 return -ENETUNREACH
;
1495 static struct cnic_dev
*cnic_cm_select_dev(struct sockaddr_in
*dst_addr
,
1498 struct cnic_dev
*dev
= NULL
;
1499 struct dst_entry
*dst
;
1500 struct net_device
*netdev
= NULL
;
1501 int err
= -ENETUNREACH
;
1503 if (dst_addr
->sin_family
== AF_INET
)
1504 err
= cnic_get_v4_route(dst_addr
, &dst
);
1505 else if (dst_addr
->sin_family
== AF_INET6
) {
1506 struct sockaddr_in6
*dst_addr6
=
1507 (struct sockaddr_in6
*) dst_addr
;
1509 err
= cnic_get_v6_route(dst_addr6
, &dst
);
1519 cnic_get_vlan(dst
->dev
, &netdev
);
1521 dev
= cnic_from_netdev(netdev
);
1530 static int cnic_resolve_addr(struct cnic_sock
*csk
, struct cnic_sockaddr
*saddr
)
1532 struct cnic_dev
*dev
= csk
->dev
;
1533 struct cnic_local
*cp
= dev
->cnic_priv
;
1535 return cnic_send_nlmsg(cp
, ISCSI_KEVENT_PATH_REQ
, csk
);
1538 static int cnic_get_route(struct cnic_sock
*csk
, struct cnic_sockaddr
*saddr
)
1540 struct cnic_dev
*dev
= csk
->dev
;
1541 struct cnic_local
*cp
= dev
->cnic_priv
;
1542 int is_v6
, err
, rc
= -ENETUNREACH
;
1543 struct dst_entry
*dst
;
1544 struct net_device
*realdev
;
1547 if (saddr
->local
.v6
.sin6_family
== AF_INET6
&&
1548 saddr
->remote
.v6
.sin6_family
== AF_INET6
)
1550 else if (saddr
->local
.v4
.sin_family
== AF_INET
&&
1551 saddr
->remote
.v4
.sin_family
== AF_INET
)
1556 clear_bit(SK_F_IPV6
, &csk
->flags
);
1559 #if defined(CONFIG_IPV6) || (defined(CONFIG_IPV6_MODULE) && defined(MODULE))
1560 set_bit(SK_F_IPV6
, &csk
->flags
);
1561 err
= cnic_get_v6_route(&saddr
->remote
.v6
, &dst
);
1565 if (!dst
|| dst
->error
|| !dst
->dev
)
1568 memcpy(&csk
->dst_ip
[0], &saddr
->remote
.v6
.sin6_addr
,
1569 sizeof(struct in6_addr
));
1570 csk
->dst_port
= saddr
->remote
.v6
.sin6_port
;
1571 local_port
= saddr
->local
.v6
.sin6_port
;
1577 err
= cnic_get_v4_route(&saddr
->remote
.v4
, &dst
);
1581 if (!dst
|| dst
->error
|| !dst
->dev
)
1584 csk
->dst_ip
[0] = saddr
->remote
.v4
.sin_addr
.s_addr
;
1585 csk
->dst_port
= saddr
->remote
.v4
.sin_port
;
1586 local_port
= saddr
->local
.v4
.sin_port
;
1589 csk
->vlan_id
= cnic_get_vlan(dst
->dev
, &realdev
);
1590 if (realdev
!= dev
->netdev
)
1593 if (local_port
>= CNIC_LOCAL_PORT_MIN
&&
1594 local_port
< CNIC_LOCAL_PORT_MAX
) {
1595 if (cnic_alloc_id(&cp
->csk_port_tbl
, local_port
))
1601 local_port
= cnic_alloc_new_id(&cp
->csk_port_tbl
);
1602 if (local_port
== -1) {
1607 csk
->src_port
= local_port
;
1609 csk
->mtu
= dst_mtu(dst
);
1617 static void cnic_init_csk_state(struct cnic_sock
*csk
)
1620 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
1621 clear_bit(SK_F_CLOSING
, &csk
->flags
);
1624 static int cnic_cm_connect(struct cnic_sock
*csk
, struct cnic_sockaddr
*saddr
)
1628 if (!cnic_in_use(csk
))
1631 if (test_and_set_bit(SK_F_CONNECT_START
, &csk
->flags
))
1634 cnic_init_csk_state(csk
);
1636 err
= cnic_get_route(csk
, saddr
);
1640 err
= cnic_resolve_addr(csk
, saddr
);
1645 clear_bit(SK_F_CONNECT_START
, &csk
->flags
);
1649 static int cnic_cm_abort(struct cnic_sock
*csk
)
1651 struct cnic_local
*cp
= csk
->dev
->cnic_priv
;
1654 if (!cnic_in_use(csk
))
1657 if (cnic_abort_prep(csk
))
1658 return cnic_cm_abort_req(csk
);
1660 /* Getting here means that we haven't started connect, or
1661 * connect was not successful.
1664 csk
->state
= L4_KCQE_OPCODE_VALUE_RESET_COMP
;
1665 if (test_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
))
1666 opcode
= csk
->state
;
1668 opcode
= L5CM_RAMROD_CMD_ID_TERMINATE_OFFLOAD
;
1669 cp
->close_conn(csk
, opcode
);
1674 static int cnic_cm_close(struct cnic_sock
*csk
)
1676 if (!cnic_in_use(csk
))
1679 if (cnic_close_prep(csk
)) {
1680 csk
->state
= L4_KCQE_OPCODE_VALUE_CLOSE_COMP
;
1681 return cnic_cm_close_req(csk
);
1686 static void cnic_cm_upcall(struct cnic_local
*cp
, struct cnic_sock
*csk
,
1689 struct cnic_ulp_ops
*ulp_ops
;
1690 int ulp_type
= csk
->ulp_type
;
1693 ulp_ops
= rcu_dereference(cp
->ulp_ops
[ulp_type
]);
1695 if (opcode
== L4_KCQE_OPCODE_VALUE_CONNECT_COMPLETE
)
1696 ulp_ops
->cm_connect_complete(csk
);
1697 else if (opcode
== L4_KCQE_OPCODE_VALUE_CLOSE_COMP
)
1698 ulp_ops
->cm_close_complete(csk
);
1699 else if (opcode
== L4_KCQE_OPCODE_VALUE_RESET_RECEIVED
)
1700 ulp_ops
->cm_remote_abort(csk
);
1701 else if (opcode
== L4_KCQE_OPCODE_VALUE_RESET_COMP
)
1702 ulp_ops
->cm_abort_complete(csk
);
1703 else if (opcode
== L4_KCQE_OPCODE_VALUE_CLOSE_RECEIVED
)
1704 ulp_ops
->cm_remote_close(csk
);
1709 static int cnic_cm_set_pg(struct cnic_sock
*csk
)
1711 if (cnic_offld_prep(csk
)) {
1712 if (test_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
))
1713 cnic_cm_update_pg(csk
);
1715 cnic_cm_offload_pg(csk
);
1720 static void cnic_cm_process_offld_pg(struct cnic_dev
*dev
, struct l4_kcq
*kcqe
)
1722 struct cnic_local
*cp
= dev
->cnic_priv
;
1723 u32 l5_cid
= kcqe
->pg_host_opaque
;
1724 u8 opcode
= kcqe
->op_code
;
1725 struct cnic_sock
*csk
= &cp
->csk_tbl
[l5_cid
];
1728 if (!cnic_in_use(csk
))
1731 if (opcode
== L4_KCQE_OPCODE_VALUE_UPDATE_PG
) {
1732 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
1735 csk
->pg_cid
= kcqe
->pg_cid
;
1736 set_bit(SK_F_PG_OFFLD_COMPLETE
, &csk
->flags
);
1737 cnic_cm_conn_req(csk
);
1743 static void cnic_cm_process_kcqe(struct cnic_dev
*dev
, struct kcqe
*kcqe
)
1745 struct cnic_local
*cp
= dev
->cnic_priv
;
1746 struct l4_kcq
*l4kcqe
= (struct l4_kcq
*) kcqe
;
1747 u8 opcode
= l4kcqe
->op_code
;
1749 struct cnic_sock
*csk
;
1751 if (opcode
== L4_KCQE_OPCODE_VALUE_OFFLOAD_PG
||
1752 opcode
== L4_KCQE_OPCODE_VALUE_UPDATE_PG
) {
1753 cnic_cm_process_offld_pg(dev
, l4kcqe
);
1757 l5_cid
= l4kcqe
->conn_id
;
1759 l5_cid
= l4kcqe
->cid
;
1760 if (l5_cid
>= MAX_CM_SK_TBL_SZ
)
1763 csk
= &cp
->csk_tbl
[l5_cid
];
1766 if (!cnic_in_use(csk
)) {
1772 case L4_KCQE_OPCODE_VALUE_CONNECT_COMPLETE
:
1773 if (l4kcqe
->status
== 0)
1774 set_bit(SK_F_OFFLD_COMPLETE
, &csk
->flags
);
1776 smp_mb__before_clear_bit();
1777 clear_bit(SK_F_OFFLD_SCHED
, &csk
->flags
);
1778 cnic_cm_upcall(cp
, csk
, opcode
);
1781 case L4_KCQE_OPCODE_VALUE_RESET_RECEIVED
:
1782 if (test_and_clear_bit(SK_F_OFFLD_COMPLETE
, &csk
->flags
))
1783 csk
->state
= opcode
;
1785 case L4_KCQE_OPCODE_VALUE_CLOSE_COMP
:
1786 case L4_KCQE_OPCODE_VALUE_RESET_COMP
:
1787 cp
->close_conn(csk
, opcode
);
1790 case L4_KCQE_OPCODE_VALUE_CLOSE_RECEIVED
:
1791 cnic_cm_upcall(cp
, csk
, opcode
);
1797 static void cnic_cm_indicate_kcqe(void *data
, struct kcqe
*kcqe
[], u32 num
)
1799 struct cnic_dev
*dev
= data
;
1802 for (i
= 0; i
< num
; i
++)
1803 cnic_cm_process_kcqe(dev
, kcqe
[i
]);
1806 static struct cnic_ulp_ops cm_ulp_ops
= {
1807 .indicate_kcqes
= cnic_cm_indicate_kcqe
,
1810 static void cnic_cm_free_mem(struct cnic_dev
*dev
)
1812 struct cnic_local
*cp
= dev
->cnic_priv
;
1816 cnic_free_id_tbl(&cp
->csk_port_tbl
);
1819 static int cnic_cm_alloc_mem(struct cnic_dev
*dev
)
1821 struct cnic_local
*cp
= dev
->cnic_priv
;
1823 cp
->csk_tbl
= kzalloc(sizeof(struct cnic_sock
) * MAX_CM_SK_TBL_SZ
,
1828 if (cnic_init_id_tbl(&cp
->csk_port_tbl
, CNIC_LOCAL_PORT_RANGE
,
1829 CNIC_LOCAL_PORT_MIN
)) {
1830 cnic_cm_free_mem(dev
);
1836 static int cnic_ready_to_close(struct cnic_sock
*csk
, u32 opcode
)
1838 if ((opcode
== csk
->state
) ||
1839 (opcode
== L4_KCQE_OPCODE_VALUE_RESET_RECEIVED
&&
1840 csk
->state
== L4_KCQE_OPCODE_VALUE_CLOSE_COMP
)) {
1841 if (!test_and_set_bit(SK_F_CLOSING
, &csk
->flags
))
1847 static void cnic_close_bnx2_conn(struct cnic_sock
*csk
, u32 opcode
)
1849 struct cnic_dev
*dev
= csk
->dev
;
1850 struct cnic_local
*cp
= dev
->cnic_priv
;
1852 clear_bit(SK_F_CONNECT_START
, &csk
->flags
);
1853 if (cnic_ready_to_close(csk
, opcode
)) {
1854 cnic_close_conn(csk
);
1855 cnic_cm_upcall(cp
, csk
, opcode
);
1859 static void cnic_cm_stop_bnx2_hw(struct cnic_dev
*dev
)
1863 static int cnic_cm_init_bnx2_hw(struct cnic_dev
*dev
)
1867 get_random_bytes(&seed
, 4);
1868 cnic_ctx_wr(dev
, 45, 0, seed
);
1872 static int cnic_cm_open(struct cnic_dev
*dev
)
1874 struct cnic_local
*cp
= dev
->cnic_priv
;
1877 err
= cnic_cm_alloc_mem(dev
);
1881 err
= cp
->start_cm(dev
);
1886 dev
->cm_create
= cnic_cm_create
;
1887 dev
->cm_destroy
= cnic_cm_destroy
;
1888 dev
->cm_connect
= cnic_cm_connect
;
1889 dev
->cm_abort
= cnic_cm_abort
;
1890 dev
->cm_close
= cnic_cm_close
;
1891 dev
->cm_select_dev
= cnic_cm_select_dev
;
1893 cp
->ulp_handle
[CNIC_ULP_L4
] = dev
;
1894 rcu_assign_pointer(cp
->ulp_ops
[CNIC_ULP_L4
], &cm_ulp_ops
);
1898 cnic_cm_free_mem(dev
);
1902 static int cnic_cm_shutdown(struct cnic_dev
*dev
)
1904 struct cnic_local
*cp
= dev
->cnic_priv
;
1912 for (i
= 0; i
< MAX_CM_SK_TBL_SZ
; i
++) {
1913 struct cnic_sock
*csk
= &cp
->csk_tbl
[i
];
1915 clear_bit(SK_F_INUSE
, &csk
->flags
);
1916 cnic_cm_cleanup(csk
);
1918 cnic_cm_free_mem(dev
);
1923 static void cnic_init_context(struct cnic_dev
*dev
, u32 cid
)
1925 struct cnic_local
*cp
= dev
->cnic_priv
;
1929 if (CHIP_NUM(cp
) == CHIP_NUM_5709
)
1932 cid_addr
= GET_CID_ADDR(cid
);
1934 for (i
= 0; i
< CTX_SIZE
; i
+= 4)
1935 cnic_ctx_wr(dev
, cid_addr
, i
, 0);
1938 static int cnic_setup_5709_context(struct cnic_dev
*dev
, int valid
)
1940 struct cnic_local
*cp
= dev
->cnic_priv
;
1942 u32 valid_bit
= valid
? BNX2_CTX_HOST_PAGE_TBL_DATA0_VALID
: 0;
1944 if (CHIP_NUM(cp
) != CHIP_NUM_5709
)
1947 for (i
= 0; i
< cp
->ctx_blks
; i
++) {
1949 u32 idx
= cp
->ctx_arr
[i
].cid
/ cp
->cids_per_blk
;
1952 memset(cp
->ctx_arr
[i
].ctx
, 0, BCM_PAGE_SIZE
);
1954 CNIC_WR(dev
, BNX2_CTX_HOST_PAGE_TBL_DATA0
,
1955 (cp
->ctx_arr
[i
].mapping
& 0xffffffff) | valid_bit
);
1956 CNIC_WR(dev
, BNX2_CTX_HOST_PAGE_TBL_DATA1
,
1957 (u64
) cp
->ctx_arr
[i
].mapping
>> 32);
1958 CNIC_WR(dev
, BNX2_CTX_HOST_PAGE_TBL_CTRL
, idx
|
1959 BNX2_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ
);
1960 for (j
= 0; j
< 10; j
++) {
1962 val
= CNIC_RD(dev
, BNX2_CTX_HOST_PAGE_TBL_CTRL
);
1963 if (!(val
& BNX2_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ
))
1967 if (val
& BNX2_CTX_HOST_PAGE_TBL_CTRL_WRITE_REQ
) {
1975 static void cnic_free_irq(struct cnic_dev
*dev
)
1977 struct cnic_local
*cp
= dev
->cnic_priv
;
1978 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
1980 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
1981 cp
->disable_int_sync(dev
);
1982 tasklet_disable(&cp
->cnic_irq_task
);
1983 free_irq(ethdev
->irq_arr
[0].vector
, dev
);
1987 static int cnic_init_bnx2_irq(struct cnic_dev
*dev
)
1989 struct cnic_local
*cp
= dev
->cnic_priv
;
1990 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
1992 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
1994 int sblk_num
= cp
->status_blk_num
;
1995 u32 base
= ((sblk_num
- 1) * BNX2_HC_SB_CONFIG_SIZE
) +
1996 BNX2_HC_SB_CONFIG_1
;
1998 CNIC_WR(dev
, base
, BNX2_HC_SB_CONFIG_1_ONE_SHOT
);
2000 CNIC_WR(dev
, base
+ BNX2_HC_COMP_PROD_TRIP_OFF
, (2 << 16) | 8);
2001 CNIC_WR(dev
, base
+ BNX2_HC_COM_TICKS_OFF
, (64 << 16) | 220);
2002 CNIC_WR(dev
, base
+ BNX2_HC_CMD_TICKS_OFF
, (64 << 16) | 220);
2004 cp
->bnx2_status_blk
= cp
->status_blk
;
2005 cp
->last_status_idx
= cp
->bnx2_status_blk
->status_idx
;
2006 tasklet_init(&cp
->cnic_irq_task
, &cnic_service_bnx2_msix
,
2007 (unsigned long) dev
);
2008 err
= request_irq(ethdev
->irq_arr
[0].vector
, cnic_irq
, 0,
2011 tasklet_disable(&cp
->cnic_irq_task
);
2014 while (cp
->bnx2_status_blk
->status_completion_producer_index
&&
2016 CNIC_WR(dev
, BNX2_HC_COALESCE_NOW
,
2017 1 << (11 + sblk_num
));
2022 if (cp
->bnx2_status_blk
->status_completion_producer_index
) {
2028 struct status_block
*sblk
= cp
->status_blk
;
2029 u32 hc_cmd
= CNIC_RD(dev
, BNX2_HC_COMMAND
);
2032 while (sblk
->status_completion_producer_index
&& i
< 10) {
2033 CNIC_WR(dev
, BNX2_HC_COMMAND
,
2034 hc_cmd
| BNX2_HC_COMMAND_COAL_NOW_WO_INT
);
2039 if (sblk
->status_completion_producer_index
)
2046 printk(KERN_ERR PFX
"%s: " "KCQ index not resetting to 0.\n",
2051 static void cnic_enable_bnx2_int(struct cnic_dev
*dev
)
2053 struct cnic_local
*cp
= dev
->cnic_priv
;
2054 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2056 if (!(ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
))
2059 CNIC_WR(dev
, BNX2_PCICFG_INT_ACK_CMD
, cp
->int_num
|
2060 BNX2_PCICFG_INT_ACK_CMD_INDEX_VALID
| cp
->last_status_idx
);
2063 static void cnic_disable_bnx2_int_sync(struct cnic_dev
*dev
)
2065 struct cnic_local
*cp
= dev
->cnic_priv
;
2066 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2068 if (!(ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
))
2071 CNIC_WR(dev
, BNX2_PCICFG_INT_ACK_CMD
, cp
->int_num
|
2072 BNX2_PCICFG_INT_ACK_CMD_MASK_INT
);
2073 CNIC_RD(dev
, BNX2_PCICFG_INT_ACK_CMD
);
2074 synchronize_irq(ethdev
->irq_arr
[0].vector
);
2077 static void cnic_init_bnx2_tx_ring(struct cnic_dev
*dev
)
2079 struct cnic_local
*cp
= dev
->cnic_priv
;
2080 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2081 u32 cid_addr
, tx_cid
, sb_id
;
2082 u32 val
, offset0
, offset1
, offset2
, offset3
;
2086 struct status_block
*s_blk
= cp
->status_blk
;
2088 sb_id
= cp
->status_blk_num
;
2090 cnic_init_context(dev
, tx_cid
);
2091 cnic_init_context(dev
, tx_cid
+ 1);
2092 cp
->tx_cons_ptr
= &s_blk
->status_tx_quick_consumer_index2
;
2093 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2094 struct status_block_msix
*sblk
= cp
->status_blk
;
2096 tx_cid
= TX_TSS_CID
+ sb_id
- 1;
2097 cnic_init_context(dev
, tx_cid
);
2098 CNIC_WR(dev
, BNX2_TSCH_TSS_CFG
, (sb_id
<< 24) |
2100 cp
->tx_cons_ptr
= &sblk
->status_tx_quick_consumer_index
;
2102 cp
->tx_cons
= *cp
->tx_cons_ptr
;
2104 cid_addr
= GET_CID_ADDR(tx_cid
);
2105 if (CHIP_NUM(cp
) == CHIP_NUM_5709
) {
2106 u32 cid_addr2
= GET_CID_ADDR(tx_cid
+ 4) + 0x40;
2108 for (i
= 0; i
< PHY_CTX_SIZE
; i
+= 4)
2109 cnic_ctx_wr(dev
, cid_addr2
, i
, 0);
2111 offset0
= BNX2_L2CTX_TYPE_XI
;
2112 offset1
= BNX2_L2CTX_CMD_TYPE_XI
;
2113 offset2
= BNX2_L2CTX_TBDR_BHADDR_HI_XI
;
2114 offset3
= BNX2_L2CTX_TBDR_BHADDR_LO_XI
;
2116 offset0
= BNX2_L2CTX_TYPE
;
2117 offset1
= BNX2_L2CTX_CMD_TYPE
;
2118 offset2
= BNX2_L2CTX_TBDR_BHADDR_HI
;
2119 offset3
= BNX2_L2CTX_TBDR_BHADDR_LO
;
2121 val
= BNX2_L2CTX_TYPE_TYPE_L2
| BNX2_L2CTX_TYPE_SIZE_L2
;
2122 cnic_ctx_wr(dev
, cid_addr
, offset0
, val
);
2124 val
= BNX2_L2CTX_CMD_TYPE_TYPE_L2
| (8 << 16);
2125 cnic_ctx_wr(dev
, cid_addr
, offset1
, val
);
2127 txbd
= (struct tx_bd
*) cp
->l2_ring
;
2129 buf_map
= cp
->l2_buf_map
;
2130 for (i
= 0; i
< MAX_TX_DESC_CNT
; i
++, txbd
++) {
2131 txbd
->tx_bd_haddr_hi
= (u64
) buf_map
>> 32;
2132 txbd
->tx_bd_haddr_lo
= (u64
) buf_map
& 0xffffffff;
2134 val
= (u64
) cp
->l2_ring_map
>> 32;
2135 cnic_ctx_wr(dev
, cid_addr
, offset2
, val
);
2136 txbd
->tx_bd_haddr_hi
= val
;
2138 val
= (u64
) cp
->l2_ring_map
& 0xffffffff;
2139 cnic_ctx_wr(dev
, cid_addr
, offset3
, val
);
2140 txbd
->tx_bd_haddr_lo
= val
;
2143 static void cnic_init_bnx2_rx_ring(struct cnic_dev
*dev
)
2145 struct cnic_local
*cp
= dev
->cnic_priv
;
2146 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2147 u32 cid_addr
, sb_id
, val
, coal_reg
, coal_val
;
2150 struct status_block
*s_blk
= cp
->status_blk
;
2152 sb_id
= cp
->status_blk_num
;
2153 cnic_init_context(dev
, 2);
2154 cp
->rx_cons_ptr
= &s_blk
->status_rx_quick_consumer_index2
;
2155 coal_reg
= BNX2_HC_COMMAND
;
2156 coal_val
= CNIC_RD(dev
, coal_reg
);
2157 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2158 struct status_block_msix
*sblk
= cp
->status_blk
;
2160 cp
->rx_cons_ptr
= &sblk
->status_rx_quick_consumer_index
;
2161 coal_reg
= BNX2_HC_COALESCE_NOW
;
2162 coal_val
= 1 << (11 + sb_id
);
2165 while (!(*cp
->rx_cons_ptr
!= 0) && i
< 10) {
2166 CNIC_WR(dev
, coal_reg
, coal_val
);
2171 cp
->rx_cons
= *cp
->rx_cons_ptr
;
2173 cid_addr
= GET_CID_ADDR(2);
2174 val
= BNX2_L2CTX_CTX_TYPE_CTX_BD_CHN_TYPE_VALUE
|
2175 BNX2_L2CTX_CTX_TYPE_SIZE_L2
| (0x02 << 8);
2176 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_CTX_TYPE
, val
);
2179 val
= 2 << BNX2_L2CTX_STATUSB_NUM_SHIFT
;
2181 val
= BNX2_L2CTX_STATUSB_NUM(sb_id
);
2182 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_HOST_BDIDX
, val
);
2184 rxbd
= (struct rx_bd
*) (cp
->l2_ring
+ BCM_PAGE_SIZE
);
2185 for (i
= 0; i
< MAX_RX_DESC_CNT
; i
++, rxbd
++) {
2187 int n
= (i
% cp
->l2_rx_ring_size
) + 1;
2189 buf_map
= cp
->l2_buf_map
+ (n
* cp
->l2_single_buf_size
);
2190 rxbd
->rx_bd_len
= cp
->l2_single_buf_size
;
2191 rxbd
->rx_bd_flags
= RX_BD_FLAGS_START
| RX_BD_FLAGS_END
;
2192 rxbd
->rx_bd_haddr_hi
= (u64
) buf_map
>> 32;
2193 rxbd
->rx_bd_haddr_lo
= (u64
) buf_map
& 0xffffffff;
2195 val
= (u64
) (cp
->l2_ring_map
+ BCM_PAGE_SIZE
) >> 32;
2196 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_NX_BDHADDR_HI
, val
);
2197 rxbd
->rx_bd_haddr_hi
= val
;
2199 val
= (u64
) (cp
->l2_ring_map
+ BCM_PAGE_SIZE
) & 0xffffffff;
2200 cnic_ctx_wr(dev
, cid_addr
, BNX2_L2CTX_NX_BDHADDR_LO
, val
);
2201 rxbd
->rx_bd_haddr_lo
= val
;
2203 val
= cnic_reg_rd_ind(dev
, BNX2_RXP_SCRATCH_RXP_FLOOD
);
2204 cnic_reg_wr_ind(dev
, BNX2_RXP_SCRATCH_RXP_FLOOD
, val
| (1 << 2));
2207 static void cnic_shutdown_bnx2_rx_ring(struct cnic_dev
*dev
)
2209 struct kwqe
*wqes
[1], l2kwqe
;
2211 memset(&l2kwqe
, 0, sizeof(l2kwqe
));
2213 l2kwqe
.kwqe_op_flag
= (L2_LAYER_CODE
<< KWQE_FLAGS_LAYER_SHIFT
) |
2214 (L2_KWQE_OPCODE_VALUE_FLUSH
<<
2215 KWQE_OPCODE_SHIFT
) | 2;
2216 dev
->submit_kwqes(dev
, wqes
, 1);
2219 static void cnic_set_bnx2_mac(struct cnic_dev
*dev
)
2221 struct cnic_local
*cp
= dev
->cnic_priv
;
2224 val
= cp
->func
<< 2;
2226 cp
->shmem_base
= cnic_reg_rd_ind(dev
, BNX2_SHM_HDR_ADDR_0
+ val
);
2228 val
= cnic_reg_rd_ind(dev
, cp
->shmem_base
+
2229 BNX2_PORT_HW_CFG_ISCSI_MAC_UPPER
);
2230 dev
->mac_addr
[0] = (u8
) (val
>> 8);
2231 dev
->mac_addr
[1] = (u8
) val
;
2233 CNIC_WR(dev
, BNX2_EMAC_MAC_MATCH4
, val
);
2235 val
= cnic_reg_rd_ind(dev
, cp
->shmem_base
+
2236 BNX2_PORT_HW_CFG_ISCSI_MAC_LOWER
);
2237 dev
->mac_addr
[2] = (u8
) (val
>> 24);
2238 dev
->mac_addr
[3] = (u8
) (val
>> 16);
2239 dev
->mac_addr
[4] = (u8
) (val
>> 8);
2240 dev
->mac_addr
[5] = (u8
) val
;
2242 CNIC_WR(dev
, BNX2_EMAC_MAC_MATCH5
, val
);
2244 val
= 4 | BNX2_RPM_SORT_USER2_BC_EN
;
2245 if (CHIP_NUM(cp
) != CHIP_NUM_5709
)
2246 val
|= BNX2_RPM_SORT_USER2_PROM_VLAN
;
2248 CNIC_WR(dev
, BNX2_RPM_SORT_USER2
, 0x0);
2249 CNIC_WR(dev
, BNX2_RPM_SORT_USER2
, val
);
2250 CNIC_WR(dev
, BNX2_RPM_SORT_USER2
, val
| BNX2_RPM_SORT_USER2_ENA
);
2253 static int cnic_start_bnx2_hw(struct cnic_dev
*dev
)
2255 struct cnic_local
*cp
= dev
->cnic_priv
;
2256 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2257 struct status_block
*sblk
= cp
->status_blk
;
2261 cnic_set_bnx2_mac(dev
);
2263 val
= CNIC_RD(dev
, BNX2_MQ_CONFIG
);
2264 val
&= ~BNX2_MQ_CONFIG_KNL_BYP_BLK_SIZE
;
2265 if (BCM_PAGE_BITS
> 12)
2266 val
|= (12 - 8) << 4;
2268 val
|= (BCM_PAGE_BITS
- 8) << 4;
2270 CNIC_WR(dev
, BNX2_MQ_CONFIG
, val
);
2272 CNIC_WR(dev
, BNX2_HC_COMP_PROD_TRIP
, (2 << 16) | 8);
2273 CNIC_WR(dev
, BNX2_HC_COM_TICKS
, (64 << 16) | 220);
2274 CNIC_WR(dev
, BNX2_HC_CMD_TICKS
, (64 << 16) | 220);
2276 err
= cnic_setup_5709_context(dev
, 1);
2280 cnic_init_context(dev
, KWQ_CID
);
2281 cnic_init_context(dev
, KCQ_CID
);
2283 cp
->kwq_cid_addr
= GET_CID_ADDR(KWQ_CID
);
2284 cp
->kwq_io_addr
= MB_GET_CID_ADDR(KWQ_CID
) + L5_KRNLQ_HOST_QIDX
;
2286 cp
->max_kwq_idx
= MAX_KWQ_IDX
;
2287 cp
->kwq_prod_idx
= 0;
2288 cp
->kwq_con_idx
= 0;
2289 cp
->cnic_local_flags
|= CNIC_LCL_FL_KWQ_INIT
;
2291 if (CHIP_NUM(cp
) == CHIP_NUM_5706
|| CHIP_NUM(cp
) == CHIP_NUM_5708
)
2292 cp
->kwq_con_idx_ptr
= &sblk
->status_rx_quick_consumer_index15
;
2294 cp
->kwq_con_idx_ptr
= &sblk
->status_cmd_consumer_index
;
2296 /* Initialize the kernel work queue context. */
2297 val
= KRNLQ_TYPE_TYPE_KRNLQ
| KRNLQ_SIZE_TYPE_SIZE
|
2298 (BCM_PAGE_BITS
- 8) | KRNLQ_FLAGS_QE_SELF_SEQ
;
2299 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_TYPE
, val
);
2301 val
= (BCM_PAGE_SIZE
/ sizeof(struct kwqe
) - 1) << 16;
2302 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_QE_SELF_SEQ_MAX
, val
);
2304 val
= ((BCM_PAGE_SIZE
/ sizeof(struct kwqe
)) << 16) | KWQ_PAGE_CNT
;
2305 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_PGTBL_NPAGES
, val
);
2307 val
= (u32
) ((u64
) cp
->kwq_info
.pgtbl_map
>> 32);
2308 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_HI
, val
);
2310 val
= (u32
) cp
->kwq_info
.pgtbl_map
;
2311 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_LO
, val
);
2313 cp
->kcq_cid_addr
= GET_CID_ADDR(KCQ_CID
);
2314 cp
->kcq_io_addr
= MB_GET_CID_ADDR(KCQ_CID
) + L5_KRNLQ_HOST_QIDX
;
2316 cp
->kcq_prod_idx
= 0;
2318 /* Initialize the kernel complete queue context. */
2319 val
= KRNLQ_TYPE_TYPE_KRNLQ
| KRNLQ_SIZE_TYPE_SIZE
|
2320 (BCM_PAGE_BITS
- 8) | KRNLQ_FLAGS_QE_SELF_SEQ
;
2321 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_TYPE
, val
);
2323 val
= (BCM_PAGE_SIZE
/ sizeof(struct kcqe
) - 1) << 16;
2324 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_QE_SELF_SEQ_MAX
, val
);
2326 val
= ((BCM_PAGE_SIZE
/ sizeof(struct kcqe
)) << 16) | KCQ_PAGE_CNT
;
2327 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_PGTBL_NPAGES
, val
);
2329 val
= (u32
) ((u64
) cp
->kcq_info
.pgtbl_map
>> 32);
2330 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_HI
, val
);
2332 val
= (u32
) cp
->kcq_info
.pgtbl_map
;
2333 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_PGTBL_HADDR_LO
, val
);
2336 if (ethdev
->drv_state
& CNIC_DRV_STATE_USING_MSIX
) {
2337 u32 sb_id
= cp
->status_blk_num
;
2338 u32 sb
= BNX2_L2CTX_STATUSB_NUM(sb_id
);
2340 cp
->int_num
= sb_id
<< BNX2_PCICFG_INT_ACK_CMD_INT_NUM_SHIFT
;
2341 cnic_ctx_wr(dev
, cp
->kwq_cid_addr
, L5_KRNLQ_HOST_QIDX
, sb
);
2342 cnic_ctx_wr(dev
, cp
->kcq_cid_addr
, L5_KRNLQ_HOST_QIDX
, sb
);
2345 /* Enable Commnad Scheduler notification when we write to the
2346 * host producer index of the kernel contexts. */
2347 CNIC_WR(dev
, BNX2_MQ_KNL_CMD_MASK1
, 2);
2349 /* Enable Command Scheduler notification when we write to either
2350 * the Send Queue or Receive Queue producer indexes of the kernel
2351 * bypass contexts. */
2352 CNIC_WR(dev
, BNX2_MQ_KNL_BYP_CMD_MASK1
, 7);
2353 CNIC_WR(dev
, BNX2_MQ_KNL_BYP_WRITE_MASK1
, 7);
2355 /* Notify COM when the driver post an application buffer. */
2356 CNIC_WR(dev
, BNX2_MQ_KNL_RX_V2P_MASK2
, 0x2000);
2358 /* Set the CP and COM doorbells. These two processors polls the
2359 * doorbell for a non zero value before running. This must be done
2360 * after setting up the kernel queue contexts. */
2361 cnic_reg_wr_ind(dev
, BNX2_CP_SCRATCH
+ 0x20, 1);
2362 cnic_reg_wr_ind(dev
, BNX2_COM_SCRATCH
+ 0x20, 1);
2364 cnic_init_bnx2_tx_ring(dev
);
2365 cnic_init_bnx2_rx_ring(dev
);
2367 err
= cnic_init_bnx2_irq(dev
);
2369 printk(KERN_ERR PFX
"%s: cnic_init_irq failed\n",
2371 cnic_reg_wr_ind(dev
, BNX2_CP_SCRATCH
+ 0x20, 0);
2372 cnic_reg_wr_ind(dev
, BNX2_COM_SCRATCH
+ 0x20, 0);
2379 static int cnic_start_hw(struct cnic_dev
*dev
)
2381 struct cnic_local
*cp
= dev
->cnic_priv
;
2382 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2385 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
))
2388 err
= ethdev
->drv_register_cnic(dev
->netdev
, cp
->cnic_ops
, dev
);
2390 printk(KERN_ERR PFX
"%s: register_cnic failed\n",
2395 dev
->regview
= ethdev
->io_base
;
2396 cp
->chip_id
= ethdev
->chip_id
;
2397 pci_dev_get(dev
->pcidev
);
2398 cp
->func
= PCI_FUNC(dev
->pcidev
->devfn
);
2399 cp
->status_blk
= ethdev
->irq_arr
[0].status_blk
;
2400 cp
->status_blk_num
= ethdev
->irq_arr
[0].status_blk_num
;
2402 err
= cp
->alloc_resc(dev
);
2404 printk(KERN_ERR PFX
"%s: allocate resource failure\n",
2409 err
= cp
->start_hw(dev
);
2413 err
= cnic_cm_open(dev
);
2417 set_bit(CNIC_F_CNIC_UP
, &dev
->flags
);
2419 cp
->enable_int(dev
);
2424 ethdev
->drv_unregister_cnic(dev
->netdev
);
2426 pci_dev_put(dev
->pcidev
);
2431 static void cnic_stop_bnx2_hw(struct cnic_dev
*dev
)
2433 struct cnic_local
*cp
= dev
->cnic_priv
;
2434 struct cnic_eth_dev
*ethdev
= cp
->ethdev
;
2436 cnic_disable_bnx2_int_sync(dev
);
2438 cnic_reg_wr_ind(dev
, BNX2_CP_SCRATCH
+ 0x20, 0);
2439 cnic_reg_wr_ind(dev
, BNX2_COM_SCRATCH
+ 0x20, 0);
2441 cnic_init_context(dev
, KWQ_CID
);
2442 cnic_init_context(dev
, KCQ_CID
);
2444 cnic_setup_5709_context(dev
, 0);
2447 ethdev
->drv_unregister_cnic(dev
->netdev
);
2449 cnic_free_resc(dev
);
2452 static void cnic_stop_hw(struct cnic_dev
*dev
)
2454 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)) {
2455 struct cnic_local
*cp
= dev
->cnic_priv
;
2457 clear_bit(CNIC_F_CNIC_UP
, &dev
->flags
);
2458 rcu_assign_pointer(cp
->ulp_ops
[CNIC_ULP_L4
], NULL
);
2460 cnic_cm_shutdown(dev
);
2462 pci_dev_put(dev
->pcidev
);
2466 static void cnic_free_dev(struct cnic_dev
*dev
)
2470 while ((atomic_read(&dev
->ref_count
) != 0) && i
< 10) {
2474 if (atomic_read(&dev
->ref_count
) != 0)
2475 printk(KERN_ERR PFX
"%s: Failed waiting for ref count to go"
2476 " to zero.\n", dev
->netdev
->name
);
2478 printk(KERN_INFO PFX
"Removed CNIC device: %s\n", dev
->netdev
->name
);
2479 dev_put(dev
->netdev
);
2483 static struct cnic_dev
*cnic_alloc_dev(struct net_device
*dev
,
2484 struct pci_dev
*pdev
)
2486 struct cnic_dev
*cdev
;
2487 struct cnic_local
*cp
;
2490 alloc_size
= sizeof(struct cnic_dev
) + sizeof(struct cnic_local
);
2492 cdev
= kzalloc(alloc_size
, GFP_KERNEL
);
2494 printk(KERN_ERR PFX
"%s: allocate dev struct failure\n",
2500 cdev
->cnic_priv
= (char *)cdev
+ sizeof(struct cnic_dev
);
2501 cdev
->register_device
= cnic_register_device
;
2502 cdev
->unregister_device
= cnic_unregister_device
;
2503 cdev
->iscsi_nl_msg_recv
= cnic_iscsi_nl_msg_recv
;
2505 cp
= cdev
->cnic_priv
;
2508 cp
->l2_single_buf_size
= 0x400;
2509 cp
->l2_rx_ring_size
= 3;
2511 spin_lock_init(&cp
->cnic_ulp_lock
);
2513 printk(KERN_INFO PFX
"Added CNIC device: %s\n", dev
->name
);
2518 static struct cnic_dev
*init_bnx2_cnic(struct net_device
*dev
)
2520 struct pci_dev
*pdev
;
2521 struct cnic_dev
*cdev
;
2522 struct cnic_local
*cp
;
2523 struct cnic_eth_dev
*ethdev
= NULL
;
2524 struct cnic_eth_dev
*(*probe
)(void *) = NULL
;
2526 probe
= __symbol_get("bnx2_cnic_probe");
2528 ethdev
= (*probe
)(dev
);
2529 symbol_put_addr(probe
);
2534 pdev
= ethdev
->pdev
;
2540 if (pdev
->device
== PCI_DEVICE_ID_NX2_5709
||
2541 pdev
->device
== PCI_DEVICE_ID_NX2_5709S
) {
2544 pci_read_config_byte(pdev
, PCI_REVISION_ID
, &rev
);
2552 cdev
= cnic_alloc_dev(dev
, pdev
);
2556 set_bit(CNIC_F_BNX2_CLASS
, &cdev
->flags
);
2557 cdev
->submit_kwqes
= cnic_submit_bnx2_kwqes
;
2559 cp
= cdev
->cnic_priv
;
2560 cp
->ethdev
= ethdev
;
2561 cdev
->pcidev
= pdev
;
2563 cp
->cnic_ops
= &cnic_bnx2_ops
;
2564 cp
->start_hw
= cnic_start_bnx2_hw
;
2565 cp
->stop_hw
= cnic_stop_bnx2_hw
;
2566 cp
->setup_pgtbl
= cnic_setup_page_tbl
;
2567 cp
->alloc_resc
= cnic_alloc_bnx2_resc
;
2568 cp
->free_resc
= cnic_free_resc
;
2569 cp
->start_cm
= cnic_cm_init_bnx2_hw
;
2570 cp
->stop_cm
= cnic_cm_stop_bnx2_hw
;
2571 cp
->enable_int
= cnic_enable_bnx2_int
;
2572 cp
->disable_int_sync
= cnic_disable_bnx2_int_sync
;
2573 cp
->close_conn
= cnic_close_bnx2_conn
;
2574 cp
->next_idx
= cnic_bnx2_next_idx
;
2575 cp
->hw_idx
= cnic_bnx2_hw_idx
;
2583 static struct cnic_dev
*is_cnic_dev(struct net_device
*dev
)
2585 struct ethtool_drvinfo drvinfo
;
2586 struct cnic_dev
*cdev
= NULL
;
2588 if (dev
->ethtool_ops
&& dev
->ethtool_ops
->get_drvinfo
) {
2589 memset(&drvinfo
, 0, sizeof(drvinfo
));
2590 dev
->ethtool_ops
->get_drvinfo(dev
, &drvinfo
);
2592 if (!strcmp(drvinfo
.driver
, "bnx2"))
2593 cdev
= init_bnx2_cnic(dev
);
2595 write_lock(&cnic_dev_lock
);
2596 list_add(&cdev
->list
, &cnic_dev_list
);
2597 write_unlock(&cnic_dev_lock
);
2604 * netdev event handler
2606 static int cnic_netdev_event(struct notifier_block
*this, unsigned long event
,
2609 struct net_device
*netdev
= ptr
;
2610 struct cnic_dev
*dev
;
2614 dev
= cnic_from_netdev(netdev
);
2616 if (!dev
&& (event
== NETDEV_REGISTER
|| event
== NETDEV_UP
)) {
2617 /* Check for the hot-plug device */
2618 dev
= is_cnic_dev(netdev
);
2625 struct cnic_local
*cp
= dev
->cnic_priv
;
2629 else if (event
== NETDEV_UNREGISTER
)
2631 else if (event
== NETDEV_UP
) {
2632 mutex_lock(&cnic_lock
);
2633 if (!cnic_start_hw(dev
))
2634 cnic_ulp_start(dev
);
2635 mutex_unlock(&cnic_lock
);
2639 for (if_type
= 0; if_type
< MAX_CNIC_ULP_TYPE
; if_type
++) {
2640 struct cnic_ulp_ops
*ulp_ops
;
2643 ulp_ops
= rcu_dereference(cp
->ulp_ops
[if_type
]);
2644 if (!ulp_ops
|| !ulp_ops
->indicate_netevent
)
2647 ctx
= cp
->ulp_handle
[if_type
];
2649 ulp_ops
->indicate_netevent(ctx
, event
);
2653 if (event
== NETDEV_GOING_DOWN
) {
2654 mutex_lock(&cnic_lock
);
2657 mutex_unlock(&cnic_lock
);
2658 } else if (event
== NETDEV_UNREGISTER
) {
2659 write_lock(&cnic_dev_lock
);
2660 list_del_init(&dev
->list
);
2661 write_unlock(&cnic_dev_lock
);
2673 static struct notifier_block cnic_netdev_notifier
= {
2674 .notifier_call
= cnic_netdev_event
2677 static void cnic_release(void)
2679 struct cnic_dev
*dev
;
2681 while (!list_empty(&cnic_dev_list
)) {
2682 dev
= list_entry(cnic_dev_list
.next
, struct cnic_dev
, list
);
2683 if (test_bit(CNIC_F_CNIC_UP
, &dev
->flags
)) {
2689 list_del_init(&dev
->list
);
2694 static int __init
cnic_init(void)
2698 printk(KERN_INFO
"%s", version
);
2700 rc
= register_netdevice_notifier(&cnic_netdev_notifier
);
2709 static void __exit
cnic_exit(void)
2711 unregister_netdevice_notifier(&cnic_netdev_notifier
);
2716 module_init(cnic_init
);
2717 module_exit(cnic_exit
);