--- /dev/null
+/*
+ comedi/drivers/ssv_dnp.c
+ generic comedi driver for SSV Embedded Systems' DIL/Net-PCs
+ Copyright (C) 2001 Robert Schwebel <robert@schwebel.de>
+
+ COMEDI - Linux Control and Measurement Device Interface
+ Copyright (C) 2000 David A. Schleef <ds@schleef.org>
+
+ 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
+ the Free Software Foundation; either version 2 of the License, or
+ (at your option) any later version.
+
+ This program is distributed in the hope that it will be useful,
+ but WITHOUT ANY WARRANTY; without even the implied warranty of
+ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ GNU General Public License for more details.
+
+ You should have received a copy of the GNU General Public License
+ along with this program; if not, write to the Free Software
+ Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+
+*/
+
+/* include files ----------------------------------------------------------- */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/sched.h>
+#include <linux/mm.h>
+#include <linux/malloc.h>
+#include <linux/errno.h>
+#include <linux/ioport.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/timex.h>
+#include <linux/timer.h>
+#include <asm/io.h>
+#include <linux/comedidev.h>
+
+
+/* Some global definitions: the registers of the DNP ----------------------- */
+/* */
+/* For port A and B the mode register has bits corresponding to the output */
+/* pins, where Bit-N = 0 -> input, Bit-N = 1 -> output. Note that bits */
+/* 4 to 7 correspond to pin 0..3 for port C data register. Ensure that bits */
+/* 0..3 remain unchanged! For details about Port C Mode Register see */
+/* the remarks in dnp_insn_config() below. */
+
+#define CSCIR 0x22 /* Chip Setup and Control Index Register */
+#define CSCDR 0x23 /* Chip Setup and Control Data Register */
+#define PAMR 0xa5 /* Port A Mode Register */
+#define PADR 0xa9 /* Port A Data Register */
+#define PBMR 0xa4 /* Port B Mode Register */
+#define PBDR 0xa8 /* Port B Data Register */
+#define PCMR 0xa3 /* Port C Mode Register */
+#define PCDR 0xa7 /* Port C Data Register */
+
+
+/* This data structure holds information about the supported boards -------- */
+
+typedef struct dnp_board_struct{
+ char *name;
+ int ai_chans;
+ int ai_bits;
+ int have_dio;
+} dnp_board;
+
+dnp_board dnp_boards[] = { /* we only support one DNP 'board' */
+ { /* variant at the moment */
+ name: "dnp-1486",
+ ai_chans: 16,
+ ai_bits: 12,
+ have_dio: 1,
+ },
+};
+
+
+/* Useful for shorthand access to the particular board structure ----------- */
+#define thisboard ((dnp_board *)dev->board_ptr)
+
+
+/* This structure is for data unique to the DNP driver --------------------- */
+typedef struct{
+ //
+} dnp_private_data;
+
+/* Shorthand macro for faster access to the private data ------------------- */
+#define devpriv ((dnp_private *)dev->private)
+
+
+/* ------------------------------------------------------------------------- */
+/* The comedi_driver structure tells the Comedi core module which functions */
+/* to call to configure/deconfigure (attach/detach) the board, and also */
+/* about the kernel module that contains the device code. */
+/* */
+/* In the following section we define the API of this driver. */
+/* ------------------------------------------------------------------------- */
+
+static int dnp_attach(comedi_device *dev,comedi_devconfig *it);
+static int dnp_detach(comedi_device *dev);
+
+comedi_driver driver_dnp = {
+ driver_name: "ssv_dnp",
+ module: THIS_MODULE,
+ attach: dnp_attach,
+ detach: dnp_detach,
+ board_name: dnp_boards, /* only necessary for non-PnP devs */
+ offset: sizeof(dnp_board), /* like ISA-PnP, PCI or PCMCIA. */
+ num_names: sizeof(dnp_boards) / sizeof(dnp_board),
+};
+
+static int dnp_dio_insn_bits(
+ comedi_device *dev,
+ comedi_subdevice *s,
+ comedi_insn *insn,
+ lsampl_t *data
+);
+
+static int dnp_dio_insn_config(
+ comedi_device *dev,
+ comedi_subdevice *s,
+ comedi_insn *insn,
+ lsampl_t *data
+);
+
+
+/* ------------------------------------------------------------------------- */
+/* Attach is called by comedi core to configure the driver for a particular */
+/* board. If you specified a board_name array in the driver structure, */
+/* dev->board_ptr contains that address. */
+/* ------------------------------------------------------------------------- */
+
+static int dnp_attach(comedi_device *dev,comedi_devconfig *it)
+{
+
+ comedi_subdevice *s;
+
+ printk("comedi%d: dnp: ",dev->minor);
+
+ /* Autoprobing: this should find out which board we have. Currently only */
+ /* the 1486 board is supported and autoprobing is not implemented :-) */
+ //dev->board_ptr = dnp_probe(dev);
+
+ /* Initialize the name of the board. We can use the "thisboard" macro now. */
+ dev->board_name = thisboard->name;
+
+ /* Allocate the private structure area. alloc_private() is a convenient */
+ /* macro defined in comedidev.h. */
+ if(alloc_private(dev,sizeof(dnp_private_data))<0) return -ENOMEM;
+
+ /* Allocate the subdevice structures. alloc_subdevice() is a convenient */
+ /* macro defined in comedidev.h. It relies on n_subdevices being set */
+ /* correctly. */
+
+ dev->n_subdevices=1;
+ if(alloc_subdevices(dev)<0) return -ENOMEM;
+
+ s=dev->subdevices+0;
+ /* digital i/o subdevice */
+ s->type = COMEDI_SUBD_DIO;
+ s->subdev_flags = SDF_READABLE|SDF_WRITEABLE;
+ s->n_chan = 20;
+ s->maxdata = 1;
+ s->range_table =& range_digital;
+ s->insn_bits = dnp_dio_insn_bits;
+ s->insn_config = dnp_dio_insn_config;
+
+ printk("attached\n");
+
+ /* allocate I/O ports: */
+ /* 0x22: Chip Setup and Control Index Register, CSCIR */
+ /* 0x23: Chip Setup and Control Data Register, CSCDR */
+ /* XXX: this area seems to be reserved by the first 8259A!?! */
+# warning region should be requested here!
+/*
+ if (check_region(0x22,2)<0) return -EBUSY;
+ if (request_region(0x22,2,"ssv_dnp")==NULL) return -EBUSY;
+*/
+
+ /* configure all ports as input (default) */
+ outb(PAMR,CSCIR); outb(0x00,CSCDR);
+ outb(PBMR,CSCIR); outb(0x00,CSCDR);
+ outb(PCMR,CSCIR); outb((inb(CSCDR) & 0xAA),CSCDR);
+
+ return 1;
+
+}
+
+
+/* ------------------------------------------------------------------------- */
+/* detach is called to deconfigure a device. It should deallocate the */
+/* resources. This function is also called when _attach() fails, so it */
+/* should be careful not to release resources that were not necessarily */
+/* allocated by _attach(). dev->private and dev->subdevices are */
+/* deallocated automatically by the core. */
+/* ------------------------------------------------------------------------- */
+
+static int dnp_detach(comedi_device *dev)
+{
+
+ /* deallocate I/O ports: */
+# warning region should be released here!
+ /*release_region(0x22,2);*/
+
+ /* configure all ports as input (default) */
+ outb(PAMR,CSCIR); outb(0x00,CSCDR);
+ outb(PBMR,CSCIR); outb(0x00,CSCDR);
+ outb(PCMR,CSCIR); outb((inb(CSCDR) & 0xAA),CSCDR);
+
+ /* announce that we are finished */
+ printk("comedi%d: dnp: remove\n",dev->minor);
+
+ return 0;
+
+}
+
+
+/* ------------------------------------------------------------------------- */
+/* The insn_bits interface allows packed reading/writing of DIO channels. */
+/* The comedi core can convert between insn_bits and insn_read/write, so you */
+/* are able to use these instructions as well. */
+/* ------------------------------------------------------------------------- */
+
+static int dnp_dio_insn_bits(
+ comedi_device *dev,
+ comedi_subdevice *s,
+ comedi_insn *insn,
+ lsampl_t *data)
+{
+
+ if (insn->n!=2) return -EINVAL; /* insn uses data[0] and data[1] */
+
+ /* The insn data is a mask in data[0] and the new data in data[1], each */
+ /* channel cooresponding to a bit. */
+
+ /* Ports A and B are straight forward: each bit corresponds to an output */
+ /* pin with the same order. Port C is different: bits 0...3 correspond to */
+ /* bits 4...7 of the output register (PCDR). */
+
+ if(data[0]){
+
+ outb(PADR,CSCIR);
+ outb(
+ (inb(CSCDR)
+ & ~(u8)(data[0] & 0x0000FF))
+ | (u8)(data[1] & 0x0000FF),
+ CSCDR
+ );
+
+ outb(PBDR,CSCIR);
+ outb(
+ (inb(CSCDR)
+ & ~(u8)((data[0] & 0x00FF00) >> 8))
+ | (u8)((data[1] & 0x00FF00) >> 8),
+ CSCDR
+ );
+
+ outb(PCDR,CSCIR);
+ outb(
+ (inb(CSCDR)
+ & ~(u8)((data[0] & 0x0F0000) >> 12))
+ | (u8)((data[1] & 0x0F0000) >> 12),
+ CSCDR
+ );
+ }
+
+ /* on return, data[1] contains the value of the digital input lines. */
+ outb(PADR,CSCIR);
+ data[0] = inb(CSCDR);
+ outb(PBDR,CSCIR);
+ data[0] += inb(CSCDR) << 8;
+ outb(PCDR,CSCIR);
+ data[0] += ((inb(CSCDR) & 0xF0) << 12);
+
+ return 2;
+
+}
+
+
+/* ------------------------------------------------------------------------- */
+/* Configure the direction of the bidirectional digital i/o pins. chanspec */
+/* contains the channel to be changed and data[0] contains either */
+/* COMEDI_INPUT or COMEDI_OUTPUT. */
+/* ------------------------------------------------------------------------- */
+
+static int dnp_dio_insn_config(
+ comedi_device *dev,
+ comedi_subdevice *s,
+ comedi_insn *insn,
+ lsampl_t *data
+)
+{
+
+ u8 register_buffer;
+
+ int chan=CR_CHAN(insn->chanspec); /* reduces chanspec to lower 16 bits */
+ if (insn->n != 1) return -EINVAL; /* this insn uses only data[0] */
+
+ /* Test: which port does the channel belong to? */
+
+ /* We have to pay attention with port C: this is the meaning of PCMR: */
+ /* Bit in PCMR: 7 6 5 4 3 2 1 0 */
+ /* Corresponding port C pin: d 3 d 2 d 1 d 0 d= don't touch */
+
+ if ((chan >= 0) && (chan <= 7)) {
+ /* this is port A */
+ outb(PAMR,CSCIR);
+ }
+ else if ((chan >= 8) && (chan <= 15)) {
+ /* this is port B */
+ chan -= 8;
+ outb(PBMR,CSCIR);
+ }
+ else if ((chan >= 16) && (chan <= 19)) {
+ /* this is port C; multiplication with 2 brings bits into correct */
+ /* position for PCMR! */
+ chan -= 16;
+ chan *= 2;
+ outb(PCMR,CSCIR);
+ }
+ else { return -EINVAL; }
+
+ /* read 'old' direction of the port and set bits (out=1, in=0) */
+ register_buffer = inb(CSCDR);
+ if (data[0] == COMEDI_OUTPUT) { register_buffer |= (1<<chan); }
+ else { register_buffer &= ~(1<<chan); }
+ outb(register_buffer,CSCDR);
+
+ return 1;
+
+}
+
+/* ------------------------------------------------------------------------- */
+/* A convenient macro that defines init_module() and cleanup_module(), */
+/* as necessary. */
+/* ------------------------------------------------------------------------- */
+
+COMEDI_INITCLEANUP(driver_dnp);
+
projects / comedi.git / commitdiff