initial

git-svn-id: svn://svn.mplayerhq.hu/mplayer/trunk@4471 b3059339-0415-0410-9bf9-f77b7e298cf2

3 files changed, 456 insertions, 0 deletions

diff --git a/libdha/kernelhelper/dhahelper.c b/libdha/kernelhelper/dhahelper.c
new file mode 100644
index 0000000000..465593ff9a
--- /dev/null
+++ b/libdha/kernelhelper/dhahelper.c
@@ -0,0 +1,332 @@
+/*
+    Direct Hardware Access kernel helper
+    
+    (C) 2002 Alex Beregszaszi <alex@naxine.org>
+    
+    Accessing hardware from userspace as USER (no root needed!)
+    
+    WARNING!
+    Don't use this on a production system! Use only at home, on a
+    "single-user" Unix system.
+
+    Tech:
+	Communication between userspace and kernelspace is going trought
+	character device using ioctl.
+
+    Usage:
+	mknod -m 666 /dev/dhahelper c 180 0
+	
+	Also you can change the major number, setting the "dhahelper_major"
+	module parameter, the default is 180, specified in dhahelper.h.
+	
+	Note: do not use other than minor==0, the module forbids it.
+
+    TODO:
+	* do memory mappin without fops:mmap
+	* implement unmap memory
+	* select (request?) a "valid" major number
+	* make security
+	* is pci handling needed? (libdha does this with lowlevel port funcs)
+	* test on older kernels (2.0.x (?) and 2.2.x)
+*/
+
+#ifndef MODULE
+#define MODULE
+#endif
+
+#ifndef __KERNEL__
+#define __KERNEL__
+#endif
+
+#include <linux/config.h>
+#include <linux/version.h>
+#include <linux/module.h>
+#include <linux/types.h>
+#include <linux/kernel.h>
+#include <linux/sched.h>
+#include <linux/mm.h>
+#include <linux/string.h>
+#include <linux/errno.h>
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,4,10)
+#include <linux/malloc.h>
+#else
+#include <linux/slab.h>
+#endif
+
+#include <linux/pci.h>
+#include <linux/ioport.h>
+#include <linux/init.h>
+
+#include <asm/uaccess.h>
+#include <asm/system.h>
+#include <asm/io.h>
+
+#include <linux/mman.h>
+
+#include <linux/fs.h>
+#include <linux/unistd.h>
+
+#include "dhahelper.h"
+
+MODULE_AUTHOR("Alex Beregszaszi <alex@naxine.org>");
+#ifdef MODULE_LICENSE
+MODULE_LICENSE("GPL"); /* modulelicensesh*t */
+#endif
+
+static int dhahelper_major = DEFAULT_MAJOR;
+MODULE_PARM(dhahelper_major, "i");
+
+/* 0 = silent */
+/* 1 = report errors (default) */
+/* 2 = debug */
+static int dhahelper_verbosity = 1;
+MODULE_PARM(dhahelper_verbosity, "i");
+
+static dhahelper_memory_t last_mem_request;
+
+
+static int dhahelper_open(struct inode *inode, struct file *file)
+{
+    if (dhahelper_verbosity > 1)
+	printk(KERN_DEBUG "dhahelper: device opened\n");
+
+    if (MINOR(inode->i_rdev) != 0)
+	return(-ENXIO);
+
+    MOD_INC_USE_COUNT;
+
+    return(0);
+}
+
+static int dhahelper_release(struct inode *inode, struct file *file)
+{
+    if (dhahelper_verbosity > 1)
+	printk(KERN_DEBUG "dhahelper: device released\n");
+
+    if (MINOR(inode->i_rdev) != 0)
+	return(-ENXIO);
+
+    MOD_DEC_USE_COUNT;
+
+    return(0);
+}
+
+static int dhahelper_ioctl(struct inode *inode, struct file *file,
+    unsigned int cmd, unsigned long arg)
+{
+    if (dhahelper_verbosity > 1)
+	printk(KERN_DEBUG "dhahelper: ioctl(cmd=%x, arg=%lx)\n",
+	    cmd, arg);
+
+    if (MINOR(inode->i_rdev) != 0)
+	return(-ENXIO);
+
+    switch(cmd)
+    {
+	case DHAHELPER_GET_VERSION:
+	{
+	    int version = API_VERSION;
+
+	    if (copy_to_user((int *)arg, &version, sizeof(int)))
+	    {
+		if (dhahelper_verbosity > 0)
+		    printk(KERN_ERR "dhahelper: failed copy to userspace\n");
+		return(-EFAULT);
+	    }
+
+	    break;
+	}
+	case DHAHELPER_PORT:
+	{
+	    dhahelper_port_t port;
+
+	    if (copy_from_user(&port, (dhahelper_port_t *)arg, sizeof(dhahelper_port_t)))
+	    {
+		if (dhahelper_verbosity > 0)
+		    printk(KERN_ERR "dhahelper: failed copy from userspace\n");
+		return(-EFAULT);
+	    }
+
+	    switch(port.operation)
+	    {
+		case PORT_OP_READ:
+		{
+		    switch(port.size)
+		    {
+			case 1:
+			    port.value = inb(port.addr);
+			    break;
+			case 2:
+			    port.value = inw(port.addr);
+			    break;
+			case 4:
+			    port.value = inl(port.addr);
+			    break;
+			default:
+			    if (dhahelper_verbosity > 0)
+				printk(KERN_ERR "dhahelper: invalid port read size (%d)\n",
+				    port.size);
+			    return(-EINVAL);
+		    }
+		    break;
+		}
+		case PORT_OP_WRITE:
+		{
+		    switch(port.size)
+		    {
+			case 1:
+			    outb(port.value, port.addr);
+			    break;
+			case 2:
+			    outw(port.value, port.addr);
+			    break;
+			case 4:
+			    outl(port.value, port.addr);
+			    break;
+			default:
+			    if (dhahelper_verbosity > 0)
+				printk(KERN_ERR "dhahelper: invalid port write size (%d)\n",
+				    port.size);
+			    return(-EINVAL);
+		    }
+		    break;
+		}
+		default:
+		    if (dhahelper_verbosity > 0)
+		        printk(KERN_ERR "dhahelper: invalid port operation (%d)\n",
+		    	    port.operation);
+		    return(-EINVAL);
+	    }
+
+	    /* copy back only if read was performed */
+	    if (port.operation == PORT_OP_READ)
+	    if (copy_to_user((dhahelper_port_t *)arg, &port, sizeof(dhahelper_port_t)))
+	    {
+		if (dhahelper_verbosity > 0)
+		    printk(KERN_ERR "dhahelper: failed copy to userspace\n");
+		return(-EFAULT);
+	    }
+	    
+	    break;
+	}
+	case DHAHELPER_MEMORY:
+	{
+	    dhahelper_memory_t mem;
+
+	    if (copy_from_user(&mem, (dhahelper_memory_t *)arg, sizeof(dhahelper_memory_t)))
+	    {
+		if (dhahelper_verbosity > 0)
+		    printk(KERN_ERR "dhahelper: failed copy from userspace\n");
+		return(-EFAULT);
+	    }
+	    
+	    switch(mem.operation)
+	    {
+		case MEMORY_OP_MAP:
+		{
+		    memcpy(&last_mem_request, &mem, sizeof(dhahelper_memory_t));
+
+		    break;
+		}
+		case MEMORY_OP_UNMAP:
+		    break;
+		default:
+		    if (dhahelper_verbosity > 0)
+			printk(KERN_ERR "dhahelper: invalid memory operation (%d)\n",
+			    mem.operation);
+		    return(-EINVAL);
+	    }
+	    
+	    if (copy_to_user((dhahelper_memory_t *)arg, &mem, sizeof(dhahelper_memory_t)))
+	    {
+		if (dhahelper_verbosity > 0)
+		    printk(KERN_ERR "dhahelper: failed copy to userspace\n");
+		return(-EFAULT);
+	    }
+	    
+	    break;
+	}
+	default:
+    	    if (dhahelper_verbosity > 0)
+		printk(KERN_ERR "dhahelper: invalid ioctl (%x)\n", cmd);
+	    return(-EINVAL);
+    }
+
+    return(0);
+}
+
+static int dhahelper_mmap(struct file *file, struct vm_area_struct *vma)
+{
+    if (last_mem_request.operation != MEMORY_OP_MAP)
+    {
+	if (dhahelper_verbosity > 0)
+	    printk(KERN_ERR "dhahelper: mapping not requested before mmap\n");
+	return(-EFAULT);
+    }
+    
+    if (dhahelper_verbosity > 1)
+	printk(KERN_INFO "dhahelper: mapping %x (size: %x)\n",
+	    last_mem_request.start+last_mem_request.offset, last_mem_request.size);
+    
+    if (remap_page_range(0, last_mem_request.start + last_mem_request.offset,
+	last_mem_request.size, vma->vm_page_prot))
+    {
+	if (dhahelper_verbosity > 0)
+	    printk(KERN_ERR "dhahelper: error mapping memory\n");
+	return(-EFAULT);
+    }
+
+    return(0);
+}
+
+#if LINUX_VERSION_CODE < KERNEL_VERSION(2,4,0)
+static struct file_operations dhahelper_fops =
+{
+    /*llseek*/	NULL,
+    /*read*/	NULL,
+    /*write*/	NULL,
+    /*readdir*/	NULL,
+    /*poll*/	NULL,
+    /*ioctl*/	dhahelper_ioctl,
+    /*mmap*/	dhahelper_mmap,
+    /*open*/	dhahelper_open,
+    /*flush*/	NULL,
+    /*release*/	dhahelper_release,
+    /* zero out the last 5 entries too ? */
+};
+#else
+static struct file_operations dhahelper_fops =
+{
+    owner:	THIS_MODULE,
+    ioctl:	dhahelper_ioctl,
+    mmap:	dhahelper_mmap,
+    open:	dhahelper_open,
+    release:	dhahelper_release
+};
+#endif
+
+static int __init init_dhahelper(void)
+{
+    printk(KERN_INFO "Direct Hardware Access kernel helper (C) Alex Beregszaszi\n");
+
+    if(register_chrdev(dhahelper_major, "dhahelper", &dhahelper_fops))
+    {
+    	if (dhahelper_verbosity > 0)
+	    printk(KERN_ERR "dhahelper: unable to register character device (major: %d)\n",
+		dhahelper_major);
+	return(-EIO);
+    }
+    
+    return(0);
+}
+
+static void __exit exit_dhahelper(void)
+{
+    unregister_chrdev(dhahelper_major, "dhahelper");
+}
+
+EXPORT_NO_SYMBOLS;
+
+module_init(init_dhahelper);
+module_exit(exit_dhahelper);
diff --git a/libdha/kernelhelper/dhahelper.h b/libdha/kernelhelper/dhahelper.h
new file mode 100644
index 0000000000..2168b42a11
--- /dev/null
+++ b/libdha/kernelhelper/dhahelper.h
@@ -0,0 +1,69 @@
+/*
+    Direct Hardware Access kernel helper
+    
+    (C) 2002 Alex Beregszaszi <alex@naxine.org>
+*/
+
+#ifndef DHAHELPER_H
+#define DHAHELPER_H
+
+#include <linux/ioctl.h>
+
+/* feel free to change */
+#define DEFAULT_MAJOR	180
+
+#define API_VERSION	0x1
+
+typedef struct dhahelper_port_s
+{
+#define PORT_OP_READ	1
+#define PORT_OP_WRITE	2
+    int		operation;
+    int		size;
+    int		addr;
+    int		value;
+} dhahelper_port_t;
+
+typedef struct dhahelper_memory_s
+{
+#define MEMORY_OP_MAP	1
+#define MEMORY_OP_UNMAP	2
+    int		operation;
+    int		start;
+    int		offset;
+    int		size;
+    int		ret;
+#define MEMORY_FLAG_NOCACHE 1
+    int		flags;
+} dhahelper_memory_t;
+
+typedef struct dhahelper_mtrr_s
+{
+#define MTRR_OP_ADD	1
+#define MTRR_OP_DEL	2
+    int		operation;
+    int		start;
+    int		size;
+    int		type;
+} dhahelper_mtrr_t;
+
+typedef struct dhahelper_pci_s
+{
+#define PCI_OP_READ	1
+#define PCI_OP_WRITE	1
+    int		operation;
+    int		bus;
+    int		dev;
+    int		func;
+    int		cmd;
+    int		size;
+    int		ret;
+} dhahelper_pci_t;
+
+#define DHAHELPER_GET_VERSION	_IOW('D', 0, int)
+#define DHAHELPER_PORT		_IOWR('D', 1, dhahelper_port_t)
+#define DHAHELPER_MEMORY	_IOWR('D', 2, dhahelper_memory_t)
+#define DHAHELPER_MTRR		_IOWR('D', 3, dhahelper_mtrr_t)
+#define DHAHELPER_PCI		_IOWR('D', 4, dhahelper_pci_t)
+
+#endif /* DHAHELPER_H */
diff --git a/libdha/kernelhelper/test.c b/libdha/kernelhelper/test.c
new file mode 100644
index 0000000000..1a44c62cf4
--- /dev/null
+++ b/libdha/kernelhelper/test.c
@@ -0,0 +1,55 @@
+#include <unistd.h>
+#include <errno.h>
+#include <fcntl.h>
+#include <sys/mman.h>
+
+#include "dhahelper.h"
+
+int main(int argc, char *argv[])
+{
+    int fd;
+    int ret;
+
+    fd = open("/dev/dhahelper", O_RDWR);
+
+    ioctl(fd, DHAHELPER_GET_VERSION, &ret);
+
+    printf("api version: %d\n", ret);
+    if (ret != API_VERSION)
+	printf("incompatible api!\n");
+
+    {
+	dhahelper_memory_t mem;
+
+	mem.operation = MEMORY_OP_MAP;
+	//mem.start = 0xe0000000;
+	mem.start = 0xe4000008;
+	mem.offset = 0;
+	mem.size = 0x4000;
+	mem.ret = 0;
+
+	ret = ioctl(fd, DHAHELPER_MEMORY, &mem);
+
+	printf("ret: %s\n", strerror(errno));
+
+	mem.ret = (int)mmap(NULL, (size_t)mem.size, PROT_READ, MAP_SHARED, fd, (off_t)0);
+	printf("allocated to %p\n", mem.ret); 
+
+	if (argc > 1)
+	    if (mem.ret != 0)
+	    {
+    		int i;
+    
+		for (i = 0; i < 256; i++)
+		    printf("[%x] ", *(int *)(mem.ret+i));
+		printf("\n");
+	    }
+
+	munmap((void *)mem.ret, mem.size);
+
+	mem.operation = MEMORY_OP_UNMAP;
+	mem.start = mem.ret;
+
+	ioctl(fd, DHAHELPER_MEMORY, &mem);
+    }
+}