2 * Copyright 2008 Cisco Systems, Inc. All rights reserved.
3 * Copyright 2007 Nuova Systems, Inc. All rights reserved.
5 * This program is free software; you may redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; version 2 of the License.
9 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
10 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
11 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
12 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
13 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
14 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
15 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
20 #include <linux/kernel.h>
21 #include <linux/errno.h>
22 #include <linux/types.h>
23 #include <linux/pci.h>
24 #include <linux/delay.h>
29 static int vnic_wq_alloc_bufs(struct vnic_wq
*wq
)
31 struct vnic_wq_buf
*buf
;
32 struct vnic_dev
*vdev
;
33 unsigned int i
, j
, count
= wq
->ring
.desc_count
;
34 unsigned int blks
= VNIC_WQ_BUF_BLKS_NEEDED(count
);
38 for (i
= 0; i
< blks
; i
++) {
39 wq
->bufs
[i
] = kzalloc(VNIC_WQ_BUF_BLK_SZ
, GFP_ATOMIC
);
41 printk(KERN_ERR
"Failed to alloc wq_bufs\n");
46 for (i
= 0; i
< blks
; i
++) {
48 for (j
= 0; j
< VNIC_WQ_BUF_BLK_ENTRIES
; j
++) {
49 buf
->index
= i
* VNIC_WQ_BUF_BLK_ENTRIES
+ j
;
50 buf
->desc
= (u8
*)wq
->ring
.descs
+
51 wq
->ring
.desc_size
* buf
->index
;
52 if (buf
->index
+ 1 == count
) {
53 buf
->next
= wq
->bufs
[0];
55 } else if (j
+ 1 == VNIC_WQ_BUF_BLK_ENTRIES
) {
56 buf
->next
= wq
->bufs
[i
+ 1];
64 wq
->to_use
= wq
->to_clean
= wq
->bufs
[0];
69 void vnic_wq_free(struct vnic_wq
*wq
)
71 struct vnic_dev
*vdev
;
76 vnic_dev_free_desc_ring(vdev
, &wq
->ring
);
78 for (i
= 0; i
< VNIC_WQ_BUF_BLKS_MAX
; i
++) {
86 int vnic_wq_alloc(struct vnic_dev
*vdev
, struct vnic_wq
*wq
, unsigned int index
,
87 unsigned int desc_count
, unsigned int desc_size
)
94 wq
->ctrl
= vnic_dev_get_res(vdev
, RES_TYPE_WQ
, index
);
96 printk(KERN_ERR
"Failed to hook WQ[%d] resource\n", index
);
102 err
= vnic_dev_alloc_desc_ring(vdev
, &wq
->ring
, desc_count
, desc_size
);
106 err
= vnic_wq_alloc_bufs(wq
);
115 void vnic_wq_init(struct vnic_wq
*wq
, unsigned int cq_index
,
116 unsigned int error_interrupt_enable
,
117 unsigned int error_interrupt_offset
)
121 paddr
= (u64
)wq
->ring
.base_addr
| VNIC_PADDR_TARGET
;
122 writeq(paddr
, &wq
->ctrl
->ring_base
);
123 iowrite32(wq
->ring
.desc_count
, &wq
->ctrl
->ring_size
);
124 iowrite32(0, &wq
->ctrl
->fetch_index
);
125 iowrite32(0, &wq
->ctrl
->posted_index
);
126 iowrite32(cq_index
, &wq
->ctrl
->cq_index
);
127 iowrite32(error_interrupt_enable
, &wq
->ctrl
->error_interrupt_enable
);
128 iowrite32(error_interrupt_offset
, &wq
->ctrl
->error_interrupt_offset
);
129 iowrite32(0, &wq
->ctrl
->error_status
);
132 unsigned int vnic_wq_error_status(struct vnic_wq
*wq
)
134 return ioread32(&wq
->ctrl
->error_status
);
137 void vnic_wq_enable(struct vnic_wq
*wq
)
139 iowrite32(1, &wq
->ctrl
->enable
);
142 int vnic_wq_disable(struct vnic_wq
*wq
)
146 iowrite32(0, &wq
->ctrl
->enable
);
148 /* Wait for HW to ACK disable request */
149 for (wait
= 0; wait
< 100; wait
++) {
150 if (!(ioread32(&wq
->ctrl
->running
)))
155 printk(KERN_ERR
"Failed to disable WQ[%d]\n", wq
->index
);
160 void vnic_wq_clean(struct vnic_wq
*wq
,
161 void (*buf_clean
)(struct vnic_wq
*wq
, struct vnic_wq_buf
*buf
))
163 struct vnic_wq_buf
*buf
;
165 BUG_ON(ioread32(&wq
->ctrl
->enable
));
169 while (vnic_wq_desc_used(wq
) > 0) {
171 (*buf_clean
)(wq
, buf
);
173 buf
= wq
->to_clean
= buf
->next
;
174 wq
->ring
.desc_avail
++;
177 wq
->to_use
= wq
->to_clean
= wq
->bufs
[0];
179 iowrite32(0, &wq
->ctrl
->fetch_index
);
180 iowrite32(0, &wq
->ctrl
->posted_index
);
181 iowrite32(0, &wq
->ctrl
->error_status
);
183 vnic_dev_clear_desc_ring(&wq
->ring
);
This page took 0.036841 seconds and 5 git commands to generate.