patch from anders re 8255

diff --git a/comedi/drivers/daqboard2000.c b/comedi/drivers/daqboard2000.c
index 8d782b48aba0d569b048da1c9d654081c70cbd41..58031871ad31adf2b86eca19d74caa0125e3419c 100644 (file)
--- a/comedi/drivers/daqboard2000.c
+++ b/comedi/drivers/daqboard2000.c
@@ -642,6 +642,22 @@ The test command, REMOVE!!:
 rmmod daqboard2000 ; rmmod comedi; make install ; modprobe daqboard2000; /usr/sbin/comedi_config /dev/comedi0 daqboard/2000 ; tail -40 /var/log/messages
 */
 
+static int daqboard2000_8255_cb(int dir, int port, int data, void *arg)
+{
+  int result = 0;
+  int iobase=(int)arg;
+  if(dir){
+    *((u16*)(iobase+port*2)) = data;
+    result = 0;
+  }else{
+    result = *((u16*)(iobase+port*2));
+  }
+/*  printk("daqboard2000_8255_cb %x %d %d %2.2x -> %2.2x\n",
+        arg, dir, port, data, result);
+*/
+  return result;
+}
+
 static int daqboard2000_attach(comedi_device *dev, comedi_devconfig *it)
 {
   int result = 0;
@@ -758,7 +774,8 @@ static int daqboard2000_attach(comedi_device *dev, comedi_devconfig *it)
     s->range_table = &range_daqboard2000_ao;
 
     s = dev->subdevices + 2;
-    result = subdev_8255_init(dev,s,NULL,(void *)(dev->iobase+0x40));
+    result = subdev_8255_init(dev,s,daqboard2000_8255_cb,
+                             (void *)(dev->iobase+0x40));
   }
   
   printk("\n");