lib/dmapool.c

#include <assert.h>
#include <dmapool.h>
#include <physmem.h>

#ifndef dma_pool_small_physmem_pool
# define dma_pool_small_physmem_pool    hsb_sram_pool
#endif
#ifndef dma_pool_large_physmem_pool
# define dma_pool_large_physmem_pool    hsb_sram_pool
#endif

void dma_pool_init_coherent_physmem(struct dma_pool *dmapool,
                struct physmem_pool *phys_pool, unsigned int nr_objects,
                size_t objsize, unsigned int align_order)
{
        phys_addr_t     pool_addr;
        size_t          pool_size;
        size_t          block_size;

        assert(dmapool);
        assert(phys_pool);
        assert(nr_objects > 0);

        block_size = round_up(objsize, align_order);
        pool_size = nr_objects * block_size;

        pool_addr = physmem_alloc(phys_pool, pool_size, align_order);
        assert(pool_addr != PHYSMEM_ALLOC_ERR);

        dma_pool_init_coherent(dmapool, pool_addr, pool_size,
                        objsize, align_order);
}

#ifdef CONFIG_DMAPOOL_GENERIC_POOLS
#include <app/config_dmapool.h>

#ifdef CONFIG_DMAPOOL_SMALL_OBJ_SIZE
struct dma_pool dmapool_size_small;
#endif
#ifdef CONFIG_DMAPOOL_LARGE_OBJ_SIZE
struct dma_pool dmapool_size_large;
#endif

void *dma_alloc_noninline(phys_addr_t *phys, size_t size)
{
        return dma_alloc_inline(phys, size);
}

void dma_free_noninline(const void *obj, size_t size)
{
        return dma_free_inline(obj, size);
}

void dma_pool_init(void)
{
#ifdef CONFIG_DMAPOOL_LARGE_OBJ_SIZE
        dma_pool_init_coherent_physmem(&dmapool_size_large,
                        &dma_pool_large_physmem_pool,
                        CONFIG_DMAPOOL_NR_LARGE_OBJS,
                        CONFIG_DMAPOOL_LARGE_OBJ_SIZE, CPU_DMA_ALIGN);
#endif
#ifdef CONFIG_DMAPOOL_SMALL_OBJ_SIZE
        dma_pool_init_coherent_physmem(&dmapool_size_small,
                        &dma_pool_small_physmem_pool,
                        CONFIG_DMAPOOL_NR_SMALL_OBJS,
                        CONFIG_DMAPOOL_SMALL_OBJ_SIZE, CPU_DMA_ALIGN);
#endif
}
#endif /* CONFIG_DMAPOOL_GENERIC_POOLS */

---