path: root/bmm_lib.c

/*
 *  bmm_lib.c
 *
 *  Buffer Management Module
 *
 *  User level BMM Defines/Globals/Functions
 *
 *  Li Li (lea.li@marvell.com)

 *(C) Copyright 2007 Marvell International Ltd.
 * All Rights Reserved
 */

#include <sys/ioctl.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/mman.h>
#include <fcntl.h>
#include <unistd.h>

#include "bmm_lib_priv.h"
#include "bmm_lib.h"

#undef DEBUG

#ifdef DEBUG
#include <stdio.h>
#define pr_debug(fmt, arg...) printf(fmt, ##arg)
#else
#define pr_debug(fmt, arg...) do { } while(0)
#endif

static int bmm_fd = -1;

int bmm_init()
{
        /* attempt to open the BMM driver */
	if(bmm_fd < 0)
		bmm_fd = open(BMM_DEVICE_FILE, O_RDWR);

	/* if the open failed, try to mount the driver */
	if(bmm_fd < 0 ) {
		system("mknod /dev/bmm c 10 94\n");
		bmm_fd = open(BMM_DEVICE_FILE, O_RDWR);
	}

	pr_debug("BMM device fd: %d", bmm_fd);

	return bmm_fd;
}

void bmm_exit()
{
	if(bmm_fd >= 0)
		close(bmm_fd);
	bmm_fd = -1;
}

void *bmm_malloc(unsigned long size, int attr)
{
	int ret;
	void *vaddr;
	ioctl_arg_t io;

	if(size == 0)
		return NULL;

	if(bmm_init() < 0)
		return NULL;

	/* obsolete, only for back-compatible */
	if ((attr & BMM_ATTR_NONBUFFERABLE)&&(attr & BMM_ATTR_NONCACHEABLE))
		attr = BMM_ATTR_NONCACHED;

	if ((!(attr & BMM_ATTR_NONBUFFERABLE))&&(attr & BMM_ATTR_NONCACHEABLE))
		attr = BMM_ATTR_WRITECOMBINE;

	io.input = size;
	io.output = 0;
	io.arg = attr;
	ret = ioctl(bmm_fd, BMM_MALLOC, &io);
	if(ret < 0 || io.output == 0)
		return NULL;

	pr_debug("bmm_malloc return paddr = 0x%08lx\n", io.output);

	vaddr = mmap(0, size, PROT_READ | PROT_WRITE, MAP_SHARED, bmm_fd, io.output);
	return ((int)vaddr == -1) ? NULL : vaddr;
}

void bmm_free(void *vaddr)
{
	unsigned long size;
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return;

	size = bmm_get_mem_size(vaddr);
	munmap(vaddr, size);

	io.input = (unsigned long)vaddr;
	io.output = 0;
	io.arg = 0;
	ioctl(bmm_fd, BMM_FREE, &io);
}

void *bmm_attach(unsigned long paddr, unsigned long len)
{
	void *vaddr;

	if(len == 0)
		return NULL;

	if(bmm_init() < 0)
		return NULL;

	vaddr = mmap(0, len, PROT_READ | PROT_WRITE, MAP_SHARED, bmm_fd, paddr);

	return ((int)vaddr == -1) ? NULL : vaddr;
}

void bmm_detach(void *vaddr, unsigned long len)
{
	if(bmm_init() < 0)
		return;

	munmap(vaddr, len);
}

void *bmm_get_vaddr(unsigned long paddr)
{
	int ret;
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return NULL;

	io.input = paddr;
	io.output = 0;
	io.arg = 0;
	ret = ioctl(bmm_fd, BMM_GET_VIRT_ADDR, &io);
	if(ret < 0)
		return NULL;

	return (void *)io.output;
}

unsigned long bmm_get_kern_paddr(void *vaddr, unsigned long size)
{
	int ret;
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return 0;

	io.input = (unsigned long)vaddr;
	io.length = (unsigned long)size;
	io.output = 0;
	io.arg = 0;
	ret = ioctl(bmm_fd, BMM_GET_KERN_PHYS_ADDR, &io);
	if(ret < 0)
		return 0;

	return io.output;
}

unsigned long bmm_get_paddr(void *vaddr)
{
	int ret;
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return 0;

	io.input = (unsigned long)vaddr;
	io.output = 0;
	io.arg = 0;
	ret = ioctl(bmm_fd,BMM_GET_PHYS_ADDR, &io);
	if(ret < 0)
		return 0;

	return io.output;
}

unsigned long bmm_get_mem_size(void *vaddr)
{
	int ret;
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return 0;

	io.input = (unsigned long)vaddr;
	io.output = 0;
	io.arg = 0;
	ret = ioctl(bmm_fd,BMM_GET_MEM_SIZE, &io);
	if(ret < 0)
		return 0;

	return io.output;
}

int bmm_get_mem_attr(void *vaddr)
{
	int ret;
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return 0;

	io.input = (unsigned long)vaddr;
	io.output = 0;
	io.arg = 0;
	ret = ioctl(bmm_fd, BMM_GET_MEM_ATTR, &io);
	if(ret < 0)
		return 0;

	return (int)io.output;
}

int bmm_set_mem_attr(void *vaddr, int attr)
{
	int ret;
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return 0;

	io.input = (unsigned long)vaddr;
	io.output = 0;
	io.arg = attr;
	ret = ioctl(bmm_fd, BMM_SET_MEM_ATTR, &io);
	if(ret < 0)
		return 0;

	return (int)io.output;
}

unsigned long bmm_get_total_space()
{
	int ret;
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return 0;

	io.input = 0;
	io.output = 0;
	io.arg = 0;
	ret = ioctl(bmm_fd, BMM_GET_TOTAL_SPACE, &io);
	if(ret < 0)
		return 0;

	return io.output;
}

unsigned long bmm_get_free_space()
{
	int ret;
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return 0;

	io.input = 0;
	io.output = 0;
	io.arg = 0;
	ret = ioctl(bmm_fd, BMM_GET_FREE_SPACE, &io);
	if(ret < 0)
		return 0;

	return io.output;
}

unsigned long bmm_get_allocated_space()
{
	int ret;
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return 0;

	io.input = 0;
	io.output = 0;
	io.arg = 0;
	ret = ioctl(bmm_fd, BMM_GET_ALLOCATED_SPACE, &io);
	if(ret < 0)
		return 0;

	return io.output;
}

void bmm_flush_cache(void *vaddr, int dir)
{
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return;

	io.input = (unsigned long)vaddr;
	io.output = 0;
	io.arg = dir;
	ioctl(bmm_fd, BMM_FLUSH_CACHE, &io);
}

void bmm_flush_cache_range(void *start, size_t size, int direction)
{
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return;

	io.input = (unsigned long)start;
	io.length = size;
	io.output = 0;
	io.arg = direction;
	ioctl(bmm_fd, BMM_CONSISTENT_SYNC, &io);
}

void bmm_flush_user(void *start, long size, int direction)
{
	ioctl_arg_t io;

	if (bmm_init() < 0)
		return;
	if (size <= 0)
		return;

	io.input = (unsigned long)start;
	io.length = size;
	io.output = 0;
	io.arg = direction;
	ioctl(bmm_fd, BMM_SYNC_USER, &io);
}

void bmm_dump()
{
	ioctl_arg_t io;

	if(bmm_init() < 0)
		return;

	io.input = 0;
	io.output = 0;
	io.arg = 0;
	ioctl(bmm_fd, BMM_DUMP, &io);
}