fl512.c

最新rtlinux内核源码

/*
    comedi/drivers/fl512.c
    Anders Gnistrup <[e-mail]>
*/

/*
Driver: fl512.o
Description: unknown
Author: unknown
Devices: [unknown] FL512 (fl512)
Status: unknown

Digital I/O is not supported.

Configuration options:
  [0] - I/O port base address
*/

#include <linux/comedidev.h>

#include <linux/delay.h>
#include <linux/ioport.h>

#define FL512_SIZE 16               /* the size of the used memory */
typedef struct {
  sampl_t ao_readback[2];
} fl512_private;
#define devpriv ((fl512_private *) dev->private)

static comedi_lrange range_fl512 =
{ 4, {
  BIP_RANGE(0.5),
  BIP_RANGE(1),
  BIP_RANGE(5),
  BIP_RANGE(10),
  UNI_RANGE(1),
  UNI_RANGE(5),
  UNI_RANGE(10),
}};

static int fl512_attach(comedi_device *dev,comedi_devconfig *it);
static int fl512_detach(comedi_device *dev);

static comedi_driver driver_fl512 = {
 driver_name: "fl512",
 module:  THIS_MODULE,
 attach:  fl512_attach,
 detach:  fl512_detach,
};
COMEDI_INITCLEANUP(driver_fl512);

static int fl512_ai_insn(comedi_device *dev,
      comedi_subdevice *s,
      comedi_insn *insn,
      lsampl_t *data);
static int fl512_ao_insn(comedi_device *dev,
      comedi_subdevice *s,
      comedi_insn *insn,
      lsampl_t *data);
static int fl512_ao_insn_readback(comedi_device *dev,
      comedi_subdevice *s,
      comedi_insn *insn,
      lsampl_t *data);

/*
 * fl512_ai_insn : this is the analog input function
 */
static int fl512_ai_insn(comedi_device *dev,
      comedi_subdevice *s,
      comedi_insn *insn,
      lsampl_t *data)
{
  int n;
  unsigned int lo_byte, hi_byte;
  char chan = CR_CHAN(insn->chanspec);
  int iobase = dev->iobase;

  for(n=0; n<insn->n; n++) {          /* sample n times on selected channel */
    /* XXX probably can move next step out of for() loop -- will make
     * AI a little bit faster. */
    outb(chan,iobase+2);              /* select chan */
    outb(0,iobase+3);                 /* start conversion */
    /* XXX should test "done" flag instead of delay */
    comedi_udelay(30);                       /* sleep 30 usec */
    lo_byte = inb(iobase+2);          /* low 8 byte */
    hi_byte = inb(iobase+3) & 0xf;    /* high 4 bit and mask */
    data[n] = lo_byte + (hi_byte << 8);
  }
  return n;
}

/*
 * fl512_ao_insn : used to write to a DA port n times
 */
static int fl512_ao_insn(comedi_device *dev,
      comedi_subdevice *s,
      comedi_insn *insn,
      lsampl_t *data)
{
  int n;
  int chan = CR_CHAN(insn->chanspec);                  /* get chan to write */
  int iobase = dev->iobase;                             /* get base address  */

  for (n=0; n<insn->n; n++) {                            /* write n data set */
    outb(data[n] & 0x0ff, iobase+4+2*chan);            /* write low byte   */
    outb((data[n] & 0xf00) >> 8, iobase+4+2*chan);     /* write high byte  */
    inb(iobase+4+2*chan);                              /* trig */

    devpriv->ao_readback[chan]=data[n];
  }
  return n;
}

/*
 * fl512_ao_insn_readback : used to read previous values written to
 * DA port
 */
static int fl512_ao_insn_readback(comedi_device *dev,
      comedi_subdevice *s,
      comedi_insn *insn,
      lsampl_t *data)
{
  int n;
  int chan = CR_CHAN(insn->chanspec);

  for (n=0; n<insn->n; n++) {
    data[n] = devpriv->ao_readback[chan];
  }

  return n;
}

/*
 * start attach
 */
static int fl512_attach(comedi_device *dev,comedi_devconfig *it)
{
  int iobase;
  comedi_subdevice *s;      /* pointer to the subdevice:
          Analog in, Analog out, ( not made ->and Digital IO) */

  iobase = it->options[0];
  printk("comedi:%d fl512: 0x%04x",dev->minor,iobase);
  if (check_region(iobase, FL512_SIZE) < 0) {
    printk(" I/O port conflict\n");
    return -EIO;
  }
  request_region(iobase, FL512_SIZE, "fl512");
  dev->iobase = iobase;
  dev->board_name = "fl512";
  if(alloc_private(dev,sizeof(fl512_private)) < 0)
    return -ENOMEM;

#if DEBUG
  printk("malloc ok\n");
#endif

  if(alloc_subdevices(dev, 2)<0)
    return -ENOMEM;

  /*
   * this if the definitions of the supdevices, 2 have been defined
   */
  /* Analog indput */
  s                = dev->subdevices+0;
  s->type          = COMEDI_SUBD_AI;         /* define subdevice as Analog In   */
  s->subdev_flags  = SDF_READABLE|SDF_GROUND;/* you can read it from userspace  */
  s->n_chan        = 16;                     /* Number of Analog input channels */
  s->maxdata       = 0x0fff;                 /* accept only 12 bits of data     */
  s->range_table   = &range_fl512;           /* device use one of the ranges    */
  s->insn_read     = fl512_ai_insn;          /* function to call when read AD   */
  printk("comedi: fl512: subdevice 0 initialized\n");

  /* Analog output */
  s                = dev->subdevices+1;
  s->type          = COMEDI_SUBD_AO;         /* define subdevice as Analog OUT   */
  s->subdev_flags  = SDF_WRITABLE;          /* you can write it from userspace  */
  s->n_chan        = 2;                      /* Number of Analog output channels */
  s->maxdata       = 0x0fff;                 /* accept only 12 bits of data      */
  s->range_table   = &range_fl512;           /* device use one of the ranges     */
  s->insn_write    = fl512_ao_insn;          /* function to call when write DA   */
  s->insn_read     = fl512_ao_insn_readback; /* function to call when reading DA   */
  printk("comedi: fl512: subdevice 1 initialized\n");

  return 1;
}

static int fl512_detach(comedi_device *dev)
{
  release_region(dev->iobase,FL512_SIZE);
  printk("comedi%d: fl512: dummy i detach\n",dev->minor);
  return 0;
}