add multi low level driver support, use kernel<->user-space copy functions

git-svn-id: svn+ssh://en.codiert.org/home/staff/ben/dev/misc.svn/projects/fpgafs@389 766a2236-cff9-0310-b0c0-a81a5f92509a

files.c

@@ -45,11 +45,6 @@ static ssize_t fpgafs_stat_read(struct file *file, char __user *buf,
 	return 4;
 }
 
-static const struct file_operations fpgafs_stat_fops = {
-	.open = fpgafs_open,
-	.read = fpgafs_stat_read,
-};
-
 static ssize_t fpgafs_cmd_write(struct file *file, const char __user *buf,
                                 size_t len, loff_t *pos)
 {
@@ -69,6 +64,11 @@ static ssize_t fpgafs_cmd_write(struct file *file, const char __user *buf,
 	return 4;
 }
 
+static const struct file_operations fpgafs_stat_fops = {
+	.open = fpgafs_open,
+	.read = fpgafs_stat_read,
+};
+
 static const struct file_operations fpgafs_cmd_fops = {
 	.open  = fpgafs_open,
 	.write = fpgafs_cmd_write,
@@ -90,11 +90,18 @@ static const struct file_operations fpgafs_dout_fops = {
 	.write = fpgafs_send_data,
 };
 
+static const struct file_operations fpgafs_lldrv_fops = {
+	.open  = fpgafs_open,
+	.write = fpgafs_write_lldrv,
+	.read  = fpgafs_read_lldrv,
+};
+
 struct tree_descr fpgafs_dir_contents[] = {
 	{ "din",  &fpgafs_din_fops, 0222, },
 	{ "dout", &fpgafs_dout_fops, 0444, },
 	{ "load", &fpgafs_load_fops, 0666, },
 	{ "cmd",  &fpgafs_cmd_fops,  0222, },
 	{ "stat", &fpgafs_stat_fops, 0444, },
+	{ "lldrv", &fpgafs_lldrv_fops, 0444, },
 	{},
 };

fpgafs.h

@@ -61,6 +61,11 @@ ssize_t fpgafs_write_load(struct file *file, const char __user *buf,
 ssize_t fpgafs_read_load(struct file *file, char __user *buf,
                                 size_t len, loff_t *pos);
 
+ssize_t fpgafs_write_lldrv(struct file *file, const char __user *buf,
+                                size_t len, loff_t *pos);
+ssize_t fpgafs_read_lldrv(struct file *file, char __user *buf,
+                                size_t len, loff_t *pos);
+
 struct fpga_context* alloc_fpga_context(void);
 void free_fpga_context(struct fpga_context *ctx);
 #endif /* FPGAFS_H */

fpgafs_lldrv_rag.c

@@ -1,10 +1,12 @@
 /*********************************************
  * Benjamin Krill <ben@codiert.org>
  *********************************************/
+#include <linux/pagemap.h>
 #include <linux/kernel.h>
 #include <linux/module.h>
 #include <linux/init.h>
 #include <linux/pci.h>
+#include <linux/mm.h>
 #include "fpgafs.h"
 
 #define VENDOR_ID_ALTERA 0x1172
@@ -14,24 +16,49 @@ static void *vaddr = 0;
 static unsigned long memstart = 0, memlen = 0;
 
 
-/* len must 2 or higher ... */
 static int fpgafs_send_data_rag(struct fpga_context *ctx, const char __user *buf, int len)
 {
 	int i;
-	for(i=0; i < len; i+=2)
+	u8 __user *usr;
-		writew((buf[i+1] << 8)|buf[i], vaddr);
+	unsigned char dat[2];
+
+	if (len < 2)
+		return -EINVAL;
+
+	if (!access_ok(VERIFY_READ, buf, len))
+		return -EFAULT;
+
+	for(i=0; i < len; i+=2) {
+		usr = (u8*)&buf[i];
+		if (__get_user(dat[0], usr))
+			return -EFAULT;
+
+		usr = (u8*)&buf[i+1];
+		if (__get_user(dat[1], usr))
+			return -EFAULT;
+
+		writew((dat[1] << 8)|dat[0], vaddr);
+	}
+
 	return i;
 }
 
-/* len must 2 or higher ... */
 static int fpgafs_recv_data_rag(struct fpga_context *ctx, unsigned char *buf, int len)
 {
 	int i; unsigned short d;
+	unsigned char b[2];
+
+	if ((len < 2) || ((len % 2) != 0))
+		return -EINVAL;
+
 	for(i=0; i < len; i+=2) {
 		d=readw((void *)((unsigned int)vaddr | 0x20));
-		buf[i] = d & 0xff;
+		b[i] = d & 0xff;
-		buf[i+1] = d >> 8;
+		b[i+1] = d >> 8;
+		if (copy_to_user(b, ctx->load_buf, 2))
+			return -EFAULT;
 	}
+
 	return i;
 }
 

llmgmt.c

@@ -1,9 +1,11 @@
 /*********************************************
  * Benjamin Krill <ben@codiert.org>
  *********************************************/
+#include <linux/pagemap.h>
 #include <linux/kernel.h>
 #include <linux/module.h>
 #include <linux/init.h>
+#include <linux/mm.h>
 #include "fpgafs.h"
 
 #define FPGAFS_MAX_LLDRV 3
@@ -20,7 +22,8 @@ struct fpga_context* alloc_fpga_context(void)
 	if (!ctx)
 		goto out;
 
-	/* do some stuff */
+	/* initialize the struct*/
+	ctx->lldrv = -1;
 
 out:
 	return ctx;
@@ -38,8 +41,9 @@ void free_fpga_context(struct fpga_context *ctx)
 ssize_t fpgafs_send_data(struct file *file, const char __user *buf,
                                 size_t len, loff_t *pos)
 {
-	return (lldrv_cur) ?
+	struct fpga_context *fcur = (struct fpga_context*)file->private_data;
-		lldrv_cur->send((struct fpga_context*)file->private_data, buf, len)
+	return (fcur->lldrv > -1) ?
+		lldrv[fcur->lldrv]->send(fcur, buf, len)
 		: -EBUSY;
 }
 EXPORT_SYMBOL_GPL(fpgafs_send_data);
@@ -47,8 +51,9 @@ EXPORT_SYMBOL_GPL(fpgafs_send_data);
 ssize_t fpgafs_recv_data(struct file *file, char __user *buf,
                                 size_t len, loff_t *pos)
 {
-	return (lldrv_cur) ?
+	struct fpga_context *fcur = (struct fpga_context*)file->private_data;
-		lldrv_cur->recv((struct fpga_context*)file->private_data, buf, len)
+	return (fcur->lldrv > -1) ?
+		lldrv[fcur->lldrv]->recv(fcur, buf, len)
 		: -EBUSY;
 }
 EXPORT_SYMBOL_GPL(fpgafs_recv_data);
@@ -56,8 +61,9 @@ EXPORT_SYMBOL_GPL(fpgafs_recv_data);
 ssize_t fpgafs_write_load(struct file *file, const char __user *buf,
                                 size_t len, loff_t *pos)
 {
-	return (lldrv_cur) ?
+	struct fpga_context *fcur = (struct fpga_context*)file->private_data;
-		lldrv_cur->write_load((struct fpga_context*)file->private_data, buf, len)
+	return (fcur->lldrv > -1) ?
+		lldrv[fcur->lldrv]->write_load(fcur, buf, len)
 		: -EBUSY;
 }
 EXPORT_SYMBOL_GPL(fpgafs_write_load);
@@ -65,12 +71,63 @@ EXPORT_SYMBOL_GPL(fpgafs_write_load);
 ssize_t fpgafs_read_load(struct file *file, char __user *buf,
                                 size_t len, loff_t *pos)
 {
-	return (lldrv_cur) ?
+	struct fpga_context *fcur = (struct fpga_context*)file->private_data;
-		lldrv_cur->read_load((struct fpga_context*)file->private_data, buf, len)
+	return (fcur->lldrv > -1) ?
+		lldrv[fcur->lldrv]->read_load(fcur, buf, len)
 		: -EBUSY;
 }
 EXPORT_SYMBOL_GPL(fpgafs_read_load);
 
+/* set/get current low level driver */
+ssize_t fpgafs_read_lldrv(struct file *file, char __user *buf,
+                                size_t len, loff_t *pos)
+{
+	struct fpga_context *fcur = (struct fpga_context*)file->private_data;
+	size_t l = (len > 5)?5:len;
+	if (fcur->lldrv > -1) {
+		if (copy_to_user(buf, lldrv[fcur->lldrv]->name, l))
+			return -EFAULT;
+	} else {
+		return -EBUSY;
+	}
+	return l;
+}
+EXPORT_SYMBOL_GPL(fpgafs_read_lldrv);
+
+ssize_t fpgafs_write_lldrv(struct file *file, const char __user *buf,
+                                size_t len, loff_t *pos)
+{
+	struct fpga_context *fcur = (struct fpga_context*)file->private_data;
+	u32 cp = 0, i;
+	u8 __user *usr;
+	unsigned char tmp[5];
+	size_t l = (len > 5)?5:len;
+
+	/* get name */
+	while (cp < l) {
+		usr = (u8*)&buf[cp];
+		if (__get_user(tmp[cp], usr))
+			return -EFAULT;
+		cp++;
+	}
+
+	for(i=0; i < FPGAFS_MAX_LLDRV; i++)
+		if (lldrv[i] != NULL) {
+			for (cp = 0; cp < l; cp++) {
+				if (lldrv[i]->name[cp] != tmp[cp])
+					break;
+			}
+			if (cp == l) {
+				fcur->lldrv = i;
+				return l;
+			}
+		}
+
+	fcur->lldrv = -1;
+	return -1;
+}
+EXPORT_SYMBOL_GPL(fpgafs_write_lldrv);
+
 /* low level un-/register functions */
 int fpgafs_register_lldrv(struct fpgafs_lldrv *drv)
 {
@@ -83,15 +140,15 @@ int fpgafs_register_lldrv(struct fpgafs_lldrv *drv)
 
 	/* find free space */
 	for(i=0; i < FPGAFS_MAX_LLDRV; i++)
-		if (lldrv[lldrv_count] == NULL) {
+		if (lldrv[i] == NULL) {
-			lldrv[lldrv_count] = drv;
+			lldrv[i] = drv;
 			break;
 		}
 
-	if (lldrv[lldrv_count]->init)
+	if (lldrv[i]->init)
-		lldrv[lldrv_count]->init();
+		lldrv[i]->init();
 
-	lldrv_cur = lldrv[lldrv_count];
+	lldrv_cur = lldrv[i];
 
 	lldrv_count++;