linux-imx

/*

 * driver/dma/coh901318_lli.c

 *

 * Copyright (C) 2007-2009 ST-Ericsson

 * License terms: GNU General Public License (GPL) version 2

 * Support functions for handling lli for dma

 * Author: Per Friden <per.friden@stericsson.com>

 */

​

#include <linux/spinlock.h>

#include <linux/memory.h>

#include <linux/gfp.h>

#include <linux/dmapool.h>

#include <linux/dmaengine.h>

​

#include "coh901318.h"

​

#if (defined(CONFIG_DEBUG_FS) && defined(CONFIG_U300_DEBUG))

#define DEBUGFS_POOL_COUNTER_RESET(pool) (pool->debugfs_pool_counter = 0)

#define DEBUGFS_POOL_COUNTER_ADD(pool, add) (pool->debugfs_pool_counter += add)

#else

#define DEBUGFS_POOL_COUNTER_RESET(pool)

#define DEBUGFS_POOL_COUNTER_ADD(pool, add)

#endif

​

static struct coh901318_lli *

coh901318_lli_next(struct coh901318_lli *data)

{

    if (data == NULL || data->link_addr == 0)

        return NULL;

​

    return (struct coh901318_lli *) data->virt_link_addr;

}

​

int coh901318_pool_create(struct coh901318_pool *pool,

              struct device *dev,

              size_t size, size_t align)

{

    spin_lock_init(&pool->lock);

    pool->dev = dev;

    pool->dmapool = dma_pool_create("lli_pool", dev, size, align, 0);

​

    DEBUGFS_POOL_COUNTER_RESET(pool);

    return 0;

}

​

int coh901318_pool_destroy(struct coh901318_pool *pool)

{

​

    dma_pool_destroy(pool->dmapool);

    return 0;

}

​

struct coh901318_lli *

coh901318_lli_alloc(struct coh901318_pool *pool, unsigned int len)

{

    int i;

    struct coh901318_lli *head;

    struct coh901318_lli *lli;

    struct coh901318_lli *lli_prev;

    dma_addr_t phy;

​

    if (len == 0)

        return NULL;

​

    spin_lock(&pool->lock);

​

    head = dma_pool_alloc(pool->dmapool, GFP_NOWAIT, &phy);

​

    if (head == NULL)

        goto err;

​

    DEBUGFS_POOL_COUNTER_ADD(pool, 1);

​

    lli = head;

    lli->phy_this = phy;

    lli->link_addr = 0x00000000;

    lli->virt_link_addr = NULL;

​

    for (i = 1; i < len; i++) {

        lli_prev = lli;

​

        lli = dma_pool_alloc(pool->dmapool, GFP_NOWAIT, &phy);

​

        if (lli == NULL)

            goto err_clean_up;

​

        DEBUGFS_POOL_COUNTER_ADD(pool, 1);

        lli->phy_this = phy;

        lli->link_addr = 0x00000000;

        lli->virt_link_addr = NULL;

​