---

yaml --- r: 141343 b: refs/heads/master c: ecf4745 h: refs/heads/master i: 141341: e5f3df4 141339: 22d5024 141335: c549f6c 141327: 62d1b0a 141311: b9f0a2a v: v3
git-mirror · Apr 3, 2009 · 05d3d10 · 05d3d10
1 parent 7272373
commit 05d3d10
Show file tree

Hide file tree

Showing 7 changed files with 58 additions and 47 deletions.
diff --git a/[refs] b/[refs]
@@ -1,2 +1,2 @@
 ---
-refs/heads/master: 5f4e925ad70446862097371dc3ba915610493891
+refs/heads/master: ecf474516696c7eb6c2f6bb8dafcf86ebca62713
diff --git a/trunk/drivers/staging/Kconfig b/trunk/drivers/staging/Kconfig
@@ -101,5 +101,7 @@ source "drivers/staging/stlc45xx/Kconfig"
 
 source "drivers/staging/uc2322/Kconfig"
 
+source "drivers/staging/b3dfg/Kconfig"
+
 endif # !STAGING_EXCLUDE_BUILD
 endif # STAGING
diff --git a/trunk/drivers/staging/Makefile b/trunk/drivers/staging/Makefile
@@ -33,3 +33,4 @@ obj-$(CONFIG_DST)		+= dst/
 obj-$(CONFIG_POHMELFS)		+= pohmelfs/
 obj-$(CONFIG_STLC45XX)		+= stlc45xx/
 obj-$(CONFIG_USB_SERIAL_ATEN2011)	+= uc2322/
+obj-$(CONFIG_B3DFG)		+= b3dfg/
diff --git a/trunk/drivers/staging/b3dfg/Kconfig b/trunk/drivers/staging/b3dfg/Kconfig
@@ -0,0 +1,9 @@
+config B3DFG
+       tristate "Brontes 3d Frame Framegrabber"
+       default n
+       ---help---
+         This driver provides support for the Brontes 3d Framegrabber
+         PCI card.
+
+         To compile this driver as a module, choose M here. The module
+         will be called b3dfg.
diff --git a/trunk/drivers/staging/b3dfg/Makefile b/trunk/drivers/staging/b3dfg/Makefile
@@ -0,0 +1 @@
+obj-$(CONFIG_B3DFG) += b3dfg.o
diff --git a/trunk/drivers/staging/b3dfg/TODO b/trunk/drivers/staging/b3dfg/TODO
@@ -0,0 +1,4 @@
+
+ - queue/wait buffer presents filltime results for each frame?
+ - counting of dropped frames
+ - review endianness
diff --git a/trunk/drivers/staging/b3dfg/b3dfg.c b/trunk/drivers/staging/b3dfg/b3dfg.c
@@ -2,7 +2,9 @@
  * Brontes PCI frame grabber driver
  *
  * Copyright (C) 2008 3M Company
- * Contact: Daniel Drake <ddrake@brontes3d.com>
+ * Contact: Justin Bronder <jsbronder@brontes3d.com>
+ * Original Authors: Daniel Drake <ddrake@brontes3d.com>
+ *                   Duane Griffin <duaneg@dghda.com>
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
@@ -34,14 +36,7 @@
 #include <linux/wait.h>
 #include <linux/mm.h>
 #include <linux/version.h>
-
-#include <asm/uaccess.h>
-
-/* TODO:
- * queue/wait buffer presents filltime results for each frame?
- * counting of dropped frames
- * review endianness
- */
+#include <linux/uaccess.h>
 
 static unsigned int b3dfg_nbuf = 2;
 
@@ -119,7 +114,7 @@ struct b3dfg_dev {
 	/* no protection needed: all finalized at initialization time */
 	struct pci_dev *pdev;
 	struct cdev chardev;
-	struct class_device *classdev;
+	struct device *dev;
 	void __iomem *regs;
 	unsigned int frame_size;
 
@@ -164,10 +159,6 @@ static dev_t b3dfg_devt;
 
 static const struct pci_device_id b3dfg_ids[] __devinitdata = {
 	{ PCI_DEVICE(0x0b3d, 0x0001) },
-
-	/* FIXME: remove this ID once all boards have been moved to 0xb3d.
-	 * Eureka's vendor ID that we borrowed before we bought our own. */
-	{ PCI_DEVICE(0x1901, 0x0001) },
 	{ },
 };
 
@@ -213,15 +204,17 @@ static int setup_frame_transfer(struct b3dfg_dev *fgdev,
 
 	frm_addr = buf->frame[frame];
 	frm_addr_dma = pci_map_single(fgdev->pdev, frm_addr,
-				      frm_size, PCI_DMA_FROMDEVICE);
-	if (pci_dma_mapping_error(frm_addr_dma))
+					  frm_size, PCI_DMA_FROMDEVICE);
+	if (pci_dma_mapping_error(fgdev->pdev, frm_addr_dma))
 		return -ENOMEM;
 
 	fgdev->cur_dma_frame_addr = frm_addr_dma;
 	fgdev->cur_dma_frame_idx = frame;
 
-	b3dfg_write32(fgdev, B3D_REG_EC220_DMA_ADDR, cpu_to_le32(frm_addr_dma));
-	b3dfg_write32(fgdev, B3D_REG_EC220_TRF_SIZE, cpu_to_le32(frm_size >> 2));
+	b3dfg_write32(fgdev, B3D_REG_EC220_DMA_ADDR,
+					cpu_to_le32(frm_addr_dma));
+	b3dfg_write32(fgdev, B3D_REG_EC220_TRF_SIZE,
+					cpu_to_le32(frm_size >> 2));
 	b3dfg_write32(fgdev, B3D_REG_EC220_DMA_STS, 0xf);
 
 	return 0;
@@ -248,6 +241,7 @@ static int queue_buffer(struct b3dfg_dev *fgdev, int bufidx)
 
 	spin_lock_irqsave(&fgdev->buffer_lock, flags);
 	if (bufidx < 0 || bufidx >= b3dfg_nbuf) {
+		dev_dbg(dev, "Invalid buffer index, %d\n", bufidx);
 		r = -ENOENT;
 		goto out;
 	}
@@ -432,11 +426,11 @@ static int wait_buffer(struct b3dfg_dev *fgdev, void __user *arg)
 }
 
 /* mmap page fault handler */
-static unsigned long b3dfg_vma_nopfn(struct vm_area_struct *vma,
-	unsigned long address)
+static int b3dfg_vma_fault(struct vm_area_struct *vma,
+	struct vm_fault *vmf)
 {
 	struct b3dfg_dev *fgdev = vma->vm_file->private_data;
-	unsigned long off = address - vma->vm_start;
+	unsigned long off = vmf->pgoff << PAGE_SHIFT;
 	unsigned int frame_size = fgdev->frame_size;
 	unsigned int buf_size = frame_size * B3DFG_FRAMES_PER_BUFFER;
 	unsigned char *addr;
@@ -452,17 +446,17 @@ static unsigned long b3dfg_vma_nopfn(struct vm_area_struct *vma,
 	unsigned int frm_off = buf_off % frame_size;
 
 	if (unlikely(buf_idx >= b3dfg_nbuf))
-		return NOPFN_SIGBUS;
+		return VM_FAULT_SIGBUS;
 
 	addr = fgdev->buffers[buf_idx].frame[frm_idx] + frm_off;
-	vm_insert_pfn(vma, vma->vm_start + off,
-		      virt_to_phys(addr) >> PAGE_SHIFT);
+	vm_insert_pfn(vma, (unsigned long)vmf->virtual_address,
+			  virt_to_phys(addr) >> PAGE_SHIFT);
 
-	return NOPFN_REFAULT;
+	return VM_FAULT_NOPAGE;
 }
 
 static struct vm_operations_struct b3dfg_vm_ops = {
-	.nopfn = b3dfg_vma_nopfn,
+	.fault = b3dfg_vma_fault,
 };
 
 static int get_wand_status(struct b3dfg_dev *fgdev, int __user *arg)
@@ -601,12 +595,12 @@ static void handle_cstate_change(struct b3dfg_dev *fgdev)
 	 * broken wire and is momentarily losing contact.
 	 *
 	 * TODO: At the moment if you plug in the cable then enable transmission
-	 *       the hardware will raise a couple of spurious interrupts, so
-	 *       just ignore them for now.
+	 * the hardware will raise a couple of spurious interrupts, so
+	 * just ignore them for now.
 	 *
-	 *      Once the hardware is fixed we should complain and treat it as an
-	 *      unplug. Or at least track how frequently it is happening and do
-	 *      so if too many come in.
+	 * Once the hardware is fixed we should complain and treat it as an
+	 * unplug. Or at least track how frequently it is happening and do
+	 * so if too many come in.
 	 */
 	if (cstate) {
 		dev_warn(dev, "ignoring unexpected plug event\n");
@@ -801,10 +795,6 @@ static long b3dfg_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
 		return __put_user(fgdev->frame_size, (int __user *) arg);
 	case B3DFG_IOCGWANDSTAT:
 		return get_wand_status(fgdev, (int __user *) arg);
-	case B3DFG_IOCTNUMBUFS:
-
-		/* TODO: Remove once userspace stops using this. */
-		return 0;
 	case B3DFG_IOCTTRANS:
 		return set_transmission(fgdev, (int) arg);
 	case B3DFG_IOCTQUEUEBUF:
@@ -970,12 +960,16 @@ static int __devinit b3dfg_probe(struct pci_dev *pdev,
 		goto err_release_minor;
 	}
 
-	fgdev->classdev = class_device_create(b3dfg_class, NULL, devno,
-					      &pdev->dev, DRIVER_NAME "%d",
-					      minor);
-	if (IS_ERR(fgdev->classdev)) {
-		dev_err(&pdev->dev, "cannot create class device\n");
-		r = PTR_ERR(fgdev->classdev);
+	fgdev->dev = device_create(
+		b3dfg_class,
+		&pdev->dev,
+		devno,
+		dev_get_drvdata(&pdev->dev),
+		DRIVER_NAME "%d", minor);
+
+	if (IS_ERR(fgdev->dev)) {
+		dev_err(&pdev->dev, "cannot create device\n");
+		r = PTR_ERR(fgdev->dev);
 		goto err_del_cdev;
 	}
 
@@ -992,12 +986,12 @@ static int __devinit b3dfg_probe(struct pci_dev *pdev,
 		goto err_disable;
 	}
 
-	if (pci_resource_flags(pdev, B3DFG_BAR_REGS) != IORESOURCE_MEM) {
+	if (pci_resource_flags(pdev, B3DFG_BAR_REGS)
+				!= (IORESOURCE_MEM | IORESOURCE_SIZEALIGN)) {
 		dev_err(&pdev->dev, "invalid resource flags\n");
 		r = -EIO;
 		goto err_disable;
 	}
-
 	r = pci_request_regions(pdev, DRIVER_NAME);
 	if (r) {
 		dev_err(&pdev->dev, "cannot obtain PCI resources\n");
@@ -1045,7 +1039,7 @@ static int __devinit b3dfg_probe(struct pci_dev *pdev,
 err_disable:
 	pci_disable_device(pdev);
 err_dev_unreg:
-	class_device_unregister(fgdev->classdev);
+	device_destroy(b3dfg_class, devno);
 err_del_cdev:
 	cdev_del(&fgdev->chardev);
 err_release_minor:
@@ -1066,7 +1060,7 @@ static void __devexit b3dfg_remove(struct pci_dev *pdev)
 	iounmap(fgdev->regs);
 	pci_release_regions(pdev);
 	pci_disable_device(pdev);
-	class_device_unregister(fgdev->classdev);
+	device_destroy(b3dfg_class, MKDEV(MAJOR(b3dfg_devt), minor));
 	cdev_del(&fgdev->chardev);
 	free_all_frame_buffers(fgdev);
 	kfree(fgdev);
@@ -1086,7 +1080,7 @@ static int __init b3dfg_module_init(void)
 
 	if (b3dfg_nbuf < 2) {
 		printk(KERN_ERR DRIVER_NAME
-		       ": buffer_count is out of range (must be >= 2)");
+			   ": buffer_count is out of range (must be >= 2)");
 		return -EINVAL;
 	}