linux-imx

/*

 * Copyright 2014 Cisco Systems, Inc.  All rights reserved.

 *

 * This program is free software; you may redistribute it and/or modify

 * it under the terms of the GNU General Public License as published by

 * the Free Software Foundation; version 2 of the License.

 *

 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,

 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF

 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND

 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS

 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN

 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN

 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE

 * SOFTWARE.

 */

​

#include <linux/errno.h>

#include <linux/types.h>

#include <linux/pci.h>

#include <linux/delay.h>

#include <linux/slab.h>

#include "vnic_dev.h"

#include "vnic_wq.h"

​

static inline int vnic_wq_get_ctrl(struct vnic_dev *vdev, struct vnic_wq *wq,

    unsigned int index, enum vnic_res_type res_type)

{

    wq->ctrl = svnic_dev_get_res(vdev, res_type, index);

    if (!wq->ctrl)

        return -EINVAL;

​

    return 0;

}

​

static inline int vnic_wq_alloc_ring(struct vnic_dev *vdev, struct vnic_wq *wq,

    unsigned int index, unsigned int desc_count, unsigned int desc_size)

{

    return svnic_dev_alloc_desc_ring(vdev, &wq->ring, desc_count,

                     desc_size);

}

​

static int vnic_wq_alloc_bufs(struct vnic_wq *wq)

{

    struct vnic_wq_buf *buf;

    unsigned int i, j, count = wq->ring.desc_count;

    unsigned int blks = VNIC_WQ_BUF_BLKS_NEEDED(count);

​

    for (i = 0; i < blks; i++) {

        wq->bufs[i] = kzalloc(VNIC_WQ_BUF_BLK_SZ, GFP_ATOMIC);

        if (!wq->bufs[i]) {

            pr_err("Failed to alloc wq_bufs\n");

​

            return -ENOMEM;

        }

    }

​

    for (i = 0; i < blks; i++) {

        buf = wq->bufs[i];

        for (j = 0; j < VNIC_WQ_BUF_DFLT_BLK_ENTRIES; j++) {

            buf->index = i * VNIC_WQ_BUF_DFLT_BLK_ENTRIES + j;

            buf->desc = (u8 *)wq->ring.descs +

                wq->ring.desc_size * buf->index;