Quelle  adl_pci6208.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0+
/*
 * adl_pci6208.c
 * Comedi driver for ADLink 6208 series cards
 *
 * COMEDI - Linux Control and Measurement Device Interface
 * Copyright (C) 2000 David A. Schleef <ds@schleef.org>
 */

/*
 * Driver: adl_pci6208
 * Description: ADLink PCI-6208/6216 Series Multi-channel Analog Output Cards
 * Devices: [ADLink] PCI-6208 (adl_pci6208), PCI-6216
 * Author: nsyeow <nsyeow@pd.jaring.my>
 * Updated: Wed, 11 Feb 2015 11:37:18 +0000
 * Status: untested
 *
 * Configuration Options: not applicable, uses PCI auto config
 *
 * All supported devices share the same PCI device ID and are treated as a
 * PCI-6216 with 16 analog output channels.  On a PCI-6208, the upper 8
 * channels exist in registers, but don't go to DAC chips.
 */

#include <linux/module.h>
#include <linux/delay.h>
#include <linux/comedi/comedi_pci.h>

/*
 * PCI-6208/6216-GL register map
 */
#define PCI6208_AO_CONTROL(x)  (0x00 + (2 * (x)))
#define PCI6208_AO_STATUS  0x00
#define PCI6208_AO_STATUS_DATA_SEND BIT(0)
#define PCI6208_DIO   0x40
#define PCI6208_DIO_DO_MASK  (0x0f)
#define PCI6208_DIO_DO_SHIFT  (0)
#define PCI6208_DIO_DI_MASK  (0xf0)
#define PCI6208_DIO_DI_SHIFT  (4)

static int pci6208_ao_eoc(struct comedi_device *dev,
     struct comedi_subdevice *s,
     struct comedi_insn *insn,
     unsigned long context)
{
 unsigned int status;

 status = inw(dev->iobase + PCI6208_AO_STATUS);
 if ((status & PCI6208_AO_STATUS_DATA_SEND) == 0)
  return 0;
 return -EBUSY;
}

static int pci6208_ao_insn_write(struct comedi_device *dev,
     struct comedi_subdevice *s,
     struct comedi_insn *insn,
     unsigned int *data)
{
 unsigned int chan = CR_CHAN(insn->chanspec);
 int ret;
 int i;

 for (i = 0; i < insn->n; i++) {
  unsigned int val = data[i];

  /* D/A transfer rate is 2.2us */
  ret = comedi_timeout(dev, s, insn, pci6208_ao_eoc, 0);
  if (ret)
   return ret;

  /* the hardware expects two's complement values */
  outw(comedi_offset_munge(s, val),
       dev->iobase + PCI6208_AO_CONTROL(chan));

  s->readback[chan] = val;
 }

 return insn->n;
}

static int pci6208_di_insn_bits(struct comedi_device *dev,
    struct comedi_subdevice *s,
    struct comedi_insn *insn,
    unsigned int *data)
{
 unsigned int val;

 val = inw(dev->iobase + PCI6208_DIO);
 val = (val & PCI6208_DIO_DI_MASK) >> PCI6208_DIO_DI_SHIFT;

 data[1] = val;

 return insn->n;
}

static int pci6208_do_insn_bits(struct comedi_device *dev,
    struct comedi_subdevice *s,
    struct comedi_insn *insn,
    unsigned int *data)
{
 if (comedi_dio_update_state(s, data))
  outw(s->state, dev->iobase + PCI6208_DIO);

 data[1] = s->state;

 return insn->n;
}

static int pci6208_auto_attach(struct comedi_device *dev,
          unsigned long context_unused)
{
 struct pci_dev *pcidev = comedi_to_pci_dev(dev);
 struct comedi_subdevice *s;
 unsigned int val;
 int ret;

 ret = comedi_pci_enable(dev);
 if (ret)
  return ret;
 dev->iobase = pci_resource_start(pcidev, 2);

 ret = comedi_alloc_subdevices(dev, 3);
 if (ret)
  return ret;

 s = &dev->subdevices[0];
 /* analog output subdevice */
 s->type  = COMEDI_SUBD_AO;
 s->subdev_flags = SDF_WRITABLE;
 s->n_chan = 16; /* Only 8 usable on PCI-6208 */
 s->maxdata = 0xffff;
 s->range_table = &range_bipolar10;
 s->insn_write = pci6208_ao_insn_write;

 ret = comedi_alloc_subdev_readback(s);
 if (ret)
  return ret;

 s = &dev->subdevices[1];
 /* digital input subdevice */
 s->type  = COMEDI_SUBD_DI;
 s->subdev_flags = SDF_READABLE;
 s->n_chan = 4;
 s->maxdata = 1;
 s->range_table = &range_digital;
 s->insn_bits = pci6208_di_insn_bits;

 s = &dev->subdevices[2];
 /* digital output subdevice */
 s->type  = COMEDI_SUBD_DO;
 s->subdev_flags = SDF_WRITABLE;
 s->n_chan = 4;
 s->maxdata = 1;
 s->range_table = &range_digital;
 s->insn_bits = pci6208_do_insn_bits;

 /*
 * Get the read back signals from the digital outputs
 * and save it as the initial state for the subdevice.
 */
 val = inw(dev->iobase + PCI6208_DIO);
 val = (val & PCI6208_DIO_DO_MASK) >> PCI6208_DIO_DO_SHIFT;
 s->state = val;

 return 0;
}

static struct comedi_driver adl_pci6208_driver = {
 .driver_name = "adl_pci6208",
 .module  = THIS_MODULE,
 .auto_attach = pci6208_auto_attach,
 .detach  = comedi_pci_detach,
};

static int adl_pci6208_pci_probe(struct pci_dev *dev,
     const struct pci_device_id *id)
{
 return comedi_pci_auto_config(dev, &adl_pci6208_driver,
          id->driver_data);
}

static const struct pci_device_id adl_pci6208_pci_table[] = {
 { PCI_DEVICE(PCI_VENDOR_ID_ADLINK, 0x6208) },
 { PCI_DEVICE_SUB(PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9050,
    0x9999, 0x6208) },
 { 0 }
};
MODULE_DEVICE_TABLE(pci, adl_pci6208_pci_table);

static struct pci_driver adl_pci6208_pci_driver = {
 .name  = "adl_pci6208",
 .id_table = adl_pci6208_pci_table,
 .probe  = adl_pci6208_pci_probe,
 .remove  = comedi_pci_auto_unconfig,
};
module_comedi_pci_driver(adl_pci6208_driver, adl_pci6208_pci_driver);

MODULE_AUTHOR("Comedi https://www.comedi.org");
MODULE_DESCRIPTION("Comedi driver for ADLink 6208 series cards");
MODULE_LICENSE("GPL");