74 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * Copyright 2008 Cisco Systems, Inc. All rights reserved.4 * Copyright 2007 Nuova Systems, Inc. All rights reserved.5 */6#include <linux/errno.h>7#include <linux/types.h>8#include <linux/pci.h>9#include "vnic_dev.h"10#include "vnic_cq.h"11 12void vnic_cq_free(struct vnic_cq *cq)13{14 vnic_dev_free_desc_ring(cq->vdev, &cq->ring);15 16 cq->ctrl = NULL;17}18 19int vnic_cq_alloc(struct vnic_dev *vdev, struct vnic_cq *cq, unsigned int index,20 unsigned int desc_count, unsigned int desc_size)21{22 int err;23 24 cq->index = index;25 cq->vdev = vdev;26 27 cq->ctrl = vnic_dev_get_res(vdev, RES_TYPE_CQ, index);28 if (!cq->ctrl) {29 printk(KERN_ERR "Failed to hook CQ[%d] resource\n", index);30 return -EINVAL;31 }32 33 err = vnic_dev_alloc_desc_ring(vdev, &cq->ring, desc_count, desc_size);34 if (err)35 return err;36 37 return 0;38}39 40void vnic_cq_init(struct vnic_cq *cq, unsigned int flow_control_enable,41 unsigned int color_enable, unsigned int cq_head, unsigned int cq_tail,42 unsigned int cq_tail_color, unsigned int interrupt_enable,43 unsigned int cq_entry_enable, unsigned int cq_message_enable,44 unsigned int interrupt_offset, u64 cq_message_addr)45{46 u64 paddr;47 48 paddr = (u64)cq->ring.base_addr | VNIC_PADDR_TARGET;49 writeq(paddr, &cq->ctrl->ring_base);50 iowrite32(cq->ring.desc_count, &cq->ctrl->ring_size);51 iowrite32(flow_control_enable, &cq->ctrl->flow_control_enable);52 iowrite32(color_enable, &cq->ctrl->color_enable);53 iowrite32(cq_head, &cq->ctrl->cq_head);54 iowrite32(cq_tail, &cq->ctrl->cq_tail);55 iowrite32(cq_tail_color, &cq->ctrl->cq_tail_color);56 iowrite32(interrupt_enable, &cq->ctrl->interrupt_enable);57 iowrite32(cq_entry_enable, &cq->ctrl->cq_entry_enable);58 iowrite32(cq_message_enable, &cq->ctrl->cq_message_enable);59 iowrite32(interrupt_offset, &cq->ctrl->interrupt_offset);60 writeq(cq_message_addr, &cq->ctrl->cq_message_addr);61}62 63void vnic_cq_clean(struct vnic_cq *cq)64{65 cq->to_clean = 0;66 cq->last_color = 0;67 68 iowrite32(0, &cq->ctrl->cq_head);69 iowrite32(0, &cq->ctrl->cq_tail);70 iowrite32(1, &cq->ctrl->cq_tail_color);71 72 vnic_dev_clear_desc_ring(&cq->ring);73}74