// SPDX-License-Identifier: GPL-2.0 /* * comedi/drivers/adv_pci_dio.c * * Author: Michal Dobes * * Hardware driver for Advantech PCI DIO cards. */ /* * Driver: adv_pci_dio * Description: Advantech Digital I/O Cards * Devices: [Advantech] PCI-1730 (adv_pci_dio), PCI-1733, * PCI-1734, PCI-1735U, PCI-1736UP, PCI-1739U, PCI-1750, * PCI-1751, PCI-1752, PCI-1753, PCI-1753+PCI-1753E, * PCI-1754, PCI-1756, PCI-1761, PCI-1762 * Author: Michal Dobes * Updated: Fri, 25 Aug 2017 07:23:06 +0300 * Status: untested * * Configuration Options: not applicable, uses PCI auto config */ #include #include #include "../comedi_pci.h" #include "8255.h" #include "comedi_8254.h" /* * Register offset definitions */ /* PCI-1730, PCI-1733, PCI-1736 interrupt control registers */ #define PCI173X_INT_EN_REG 0x08 /* R/W: enable/disable */ #define PCI173X_INT_RF_REG 0x0c /* R/W: falling/rising edge */ #define PCI173X_INT_CLR_REG 0x10 /* R/W: clear */ /* PCI-1739U, PCI-1750, PCI1751 interrupt control registers */ #define PCI1750_INT_REG 0x20 /* R/W: status/control */ /* PCI-1753, PCI-1753E interrupt control registers */ #define PCI1753_INT_REG(x) (0x10 + (x)) /* R/W: control group 0 to 3 */ #define PCI1753E_INT_REG(x) (0x30 + (x)) /* R/W: control group 0 to 3 */ /* PCI-1754, PCI-1756 interrupt control registers */ #define PCI1754_INT_REG(x) (0x08 + (x) * 2) /* R/W: control group 0 to 3 */ /* PCI-1752, PCI-1756 special registers */ #define PCI1752_CFC_REG 0x12 /* R/W: channel freeze function */ /* PCI-1761 interrupt control registers */ #define PCI1761_INT_EN_REG 0x03 /* R/W: enable/disable interrupts */ #define PCI1761_INT_RF_REG 0x04 /* R/W: falling/rising edge */ #define PCI1761_INT_CLR_REG 0x05 /* R/W: clear interrupts */ /* PCI-1762 interrupt control registers */ #define PCI1762_INT_REG 0x06 /* R/W: status/control */ /* maximum number of subdevice descriptions in the boardinfo */ #define PCI_DIO_MAX_DI_SUBDEVS 2 /* 2 x 8/16/32 input channels max */ #define PCI_DIO_MAX_DO_SUBDEVS 2 /* 2 x 8/16/32 output channels max */ #define PCI_DIO_MAX_DIO_SUBDEVG 2 /* 2 x any number of 8255 devices max */ enum pci_dio_boardid { TYPE_PCI1730, TYPE_PCI1733, TYPE_PCI1734, TYPE_PCI1735, TYPE_PCI1736, TYPE_PCI1739, TYPE_PCI1750, TYPE_PCI1751, TYPE_PCI1752, TYPE_PCI1753, TYPE_PCI1753E, TYPE_PCI1754, TYPE_PCI1756, TYPE_PCI1761, TYPE_PCI1762 }; struct diosubd_data { int chans; /* num of chans or 8255 devices */ unsigned long addr; /* PCI address ofset */ }; struct dio_boardtype { const char *name; /* board name */ int nsubdevs; struct diosubd_data sdi[PCI_DIO_MAX_DI_SUBDEVS]; struct diosubd_data sdo[PCI_DIO_MAX_DO_SUBDEVS]; struct diosubd_data sdio[PCI_DIO_MAX_DIO_SUBDEVG]; unsigned long id_reg; unsigned long timer_regbase; unsigned int is_16bit:1; }; static const struct dio_boardtype boardtypes[] = { [TYPE_PCI1730] = { .name = "pci1730", .nsubdevs = 5, .sdi[0] = { 16, 0x02, }, /* DI 0-15 */ .sdi[1] = { 16, 0x00, }, /* ISO DI 0-15 */ .sdo[0] = { 16, 0x02, }, /* DO 0-15 */ .sdo[1] = { 16, 0x00, }, /* ISO DO 0-15 */ .id_reg = 0x04, }, [TYPE_PCI1733] = { .name = "pci1733", .nsubdevs = 2, .sdi[1] = { 32, 0x00, }, /* ISO DI 0-31 */ .id_reg = 0x04, }, [TYPE_PCI1734] = { .name = "pci1734", .nsubdevs = 2, .sdo[1] = { 32, 0x00, }, /* ISO DO 0-31 */ .id_reg = 0x04, }, [TYPE_PCI1735] = { .name = "pci1735", .nsubdevs = 4, .sdi[0] = { 32, 0x00, }, /* DI 0-31 */ .sdo[0] = { 32, 0x00, }, /* DO 0-31 */ .id_reg = 0x08, .timer_regbase = 0x04, }, [TYPE_PCI1736] = { .name = "pci1736", .nsubdevs = 3, .sdi[1] = { 16, 0x00, }, /* ISO DI 0-15 */ .sdo[1] = { 16, 0x00, }, /* ISO DO 0-15 */ .id_reg = 0x04, }, [TYPE_PCI1739] = { .name = "pci1739", .nsubdevs = 3, .sdio[0] = { 2, 0x00, }, /* 8255 DIO */ .id_reg = 0x08, }, [TYPE_PCI1750] = { .name = "pci1750", .nsubdevs = 2, .sdi[1] = { 16, 0x00, }, /* ISO DI 0-15 */ .sdo[1] = { 16, 0x00, }, /* ISO DO 0-15 */ }, [TYPE_PCI1751] = { .name = "pci1751", .nsubdevs = 3, .sdio[0] = { 2, 0x00, }, /* 8255 DIO */ .timer_regbase = 0x18, }, [TYPE_PCI1752] = { .name = "pci1752", .nsubdevs = 3, .sdo[0] = { 32, 0x00, }, /* DO 0-31 */ .sdo[1] = { 32, 0x04, }, /* DO 32-63 */ .id_reg = 0x10, .is_16bit = 1, }, [TYPE_PCI1753] = { .name = "pci1753", .nsubdevs = 4, .sdio[0] = { 4, 0x00, }, /* 8255 DIO */ }, [TYPE_PCI1753E] = { .name = "pci1753e", .nsubdevs = 8, .sdio[0] = { 4, 0x00, }, /* 8255 DIO */ .sdio[1] = { 4, 0x20, }, /* 8255 DIO */ }, [TYPE_PCI1754] = { .name = "pci1754", .nsubdevs = 3, .sdi[0] = { 32, 0x00, }, /* DI 0-31 */ .sdi[1] = { 32, 0x04, }, /* DI 32-63 */ .id_reg = 0x10, .is_16bit = 1, }, [TYPE_PCI1756] = { .name = "pci1756", .nsubdevs = 3, .sdi[1] = { 32, 0x00, }, /* DI 0-31 */ .sdo[1] = { 32, 0x04, }, /* DO 0-31 */ .id_reg = 0x10, .is_16bit = 1, }, [TYPE_PCI1761] = { .name = "pci1761", .nsubdevs = 3, .sdi[1] = { 8, 0x01 }, /* ISO DI 0-7 */ .sdo[1] = { 8, 0x00 }, /* RELAY DO 0-7 */ .id_reg = 0x02, }, [TYPE_PCI1762] = { .name = "pci1762", .nsubdevs = 3, .sdi[1] = { 16, 0x02, }, /* ISO DI 0-15 */ .sdo[1] = { 16, 0x00, }, /* ISO DO 0-15 */ .id_reg = 0x04, .is_16bit = 1, }, }; static int pci_dio_insn_bits_di_b(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { unsigned long reg = (unsigned long)s->private; unsigned long iobase = dev->iobase + reg; data[1] = inb(iobase); if (s->n_chan > 8) data[1] |= (inb(iobase + 1) << 8); if (s->n_chan > 16) data[1] |= (inb(iobase + 2) << 16); if (s->n_chan > 24) data[1] |= (inb(iobase + 3) << 24); return insn->n; } static int pci_dio_insn_bits_di_w(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { unsigned long reg = (unsigned long)s->private; unsigned long iobase = dev->iobase + reg; data[1] = inw(iobase); if (s->n_chan > 16) data[1] |= (inw(iobase + 2) << 16); return insn->n; } static int pci_dio_insn_bits_do_b(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { unsigned long reg = (unsigned long)s->private; unsigned long iobase = dev->iobase + reg; if (comedi_dio_update_state(s, data)) { outb(s->state & 0xff, iobase); if (s->n_chan > 8) outb((s->state >> 8) & 0xff, iobase + 1); if (s->n_chan > 16) outb((s->state >> 16) & 0xff, iobase + 2); if (s->n_chan > 24) outb((s->state >> 24) & 0xff, iobase + 3); } data[1] = s->state; return insn->n; } static int pci_dio_insn_bits_do_w(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { unsigned long reg = (unsigned long)s->private; unsigned long iobase = dev->iobase + reg; if (comedi_dio_update_state(s, data)) { outw(s->state & 0xffff, iobase); if (s->n_chan > 16) outw((s->state >> 16) & 0xffff, iobase + 2); } data[1] = s->state; return insn->n; } static int pci_dio_reset(struct comedi_device *dev, unsigned long cardtype) { /* disable channel freeze function on the PCI-1752/1756 boards */ if (cardtype == TYPE_PCI1752 || cardtype == TYPE_PCI1756) outw(0, dev->iobase + PCI1752_CFC_REG); /* disable and clear interrupts */ switch (cardtype) { case TYPE_PCI1730: case TYPE_PCI1733: case TYPE_PCI1736: outb(0, dev->iobase + PCI173X_INT_EN_REG); outb(0x0f, dev->iobase + PCI173X_INT_CLR_REG); outb(0, dev->iobase + PCI173X_INT_RF_REG); break; case TYPE_PCI1739: case TYPE_PCI1750: case TYPE_PCI1751: outb(0x88, dev->iobase + PCI1750_INT_REG); break; case TYPE_PCI1753: case TYPE_PCI1753E: outb(0x88, dev->iobase + PCI1753_INT_REG(0)); outb(0x80, dev->iobase + PCI1753_INT_REG(1)); outb(0x80, dev->iobase + PCI1753_INT_REG(2)); outb(0x80, dev->iobase + PCI1753_INT_REG(3)); if (cardtype == TYPE_PCI1753E) { outb(0x88, dev->iobase + PCI1753E_INT_REG(0)); outb(0x80, dev->iobase + PCI1753E_INT_REG(1)); outb(0x80, dev->iobase + PCI1753E_INT_REG(2)); outb(0x80, dev->iobase + PCI1753E_INT_REG(3)); } break; case TYPE_PCI1754: case TYPE_PCI1756: outw(0x08, dev->iobase + PCI1754_INT_REG(0)); outw(0x08, dev->iobase + PCI1754_INT_REG(1)); if (cardtype == TYPE_PCI1754) { outw(0x08, dev->iobase + PCI1754_INT_REG(2)); outw(0x08, dev->iobase + PCI1754_INT_REG(3)); } break; case TYPE_PCI1761: /* disable interrupts */ outb(0, dev->iobase + PCI1761_INT_EN_REG); /* clear interrupts */ outb(0xff, dev->iobase + PCI1761_INT_CLR_REG); /* set rising edge trigger */ outb(0, dev->iobase + PCI1761_INT_RF_REG); break; case TYPE_PCI1762: outw(0x0101, dev->iobase + PCI1762_INT_REG); break; default: break; } return 0; } static int pci_dio_auto_attach(struct comedi_device *dev, unsigned long context) { struct pci_dev *pcidev = comedi_to_pci_dev(dev); const struct dio_boardtype *board = NULL; const struct diosubd_data *d; struct comedi_subdevice *s; int ret, subdev, i, j; if (context < ARRAY_SIZE(boardtypes)) board = &boardtypes[context]; if (!board) return -ENODEV; dev->board_ptr = board; dev->board_name = board->name; ret = comedi_pci_enable(dev); if (ret) return ret; if (context == TYPE_PCI1736) dev->iobase = pci_resource_start(pcidev, 0); else dev->iobase = pci_resource_start(pcidev, 2); pci_dio_reset(dev, context); ret = comedi_alloc_subdevices(dev, board->nsubdevs); if (ret) return ret; subdev = 0; for (i = 0; i < PCI_DIO_MAX_DI_SUBDEVS; i++) { d = &board->sdi[i]; if (d->chans) { s = &dev->subdevices[subdev++]; s->type = COMEDI_SUBD_DI; s->subdev_flags = SDF_READABLE; s->n_chan = d->chans; s->maxdata = 1; s->range_table = &range_digital; s->insn_bits = board->is_16bit ? pci_dio_insn_bits_di_w : pci_dio_insn_bits_di_b; s->private = (void *)d->addr; } } for (i = 0; i < PCI_DIO_MAX_DO_SUBDEVS; i++) { d = &board->sdo[i]; if (d->chans) { s = &dev->subdevices[subdev++]; s->type = COMEDI_SUBD_DO; s->subdev_flags = SDF_WRITABLE; s->n_chan = d->chans; s->maxdata = 1; s->range_table = &range_digital; s->insn_bits = board->is_16bit ? pci_dio_insn_bits_do_w : pci_dio_insn_bits_do_b; s->private = (void *)d->addr; /* reset all outputs to 0 */ if (board->is_16bit) { outw(0, dev->iobase + d->addr); if (s->n_chan > 16) outw(0, dev->iobase + d->addr + 2); } else { outb(0, dev->iobase + d->addr); if (s->n_chan > 8) outb(0, dev->iobase + d->addr + 1); if (s->n_chan > 16) outb(0, dev->iobase + d->addr + 2); if (s->n_chan > 24) outb(0, dev->iobase + d->addr + 3); } } } for (i = 0; i < PCI_DIO_MAX_DIO_SUBDEVG; i++) { d = &board->sdio[i]; for (j = 0; j < d->chans; j++) { s = &dev->subdevices[subdev++]; ret = subdev_8255_init(dev, s, NULL, d->addr + j * I8255_SIZE); if (ret) return ret; } } if (board->id_reg) { s = &dev->subdevices[subdev++]; s->type = COMEDI_SUBD_DI; s->subdev_flags = SDF_READABLE | SDF_INTERNAL; s->n_chan = 4; s->maxdata = 1; s->range_table = &range_digital; s->insn_bits = board->is_16bit ? pci_dio_insn_bits_di_w : pci_dio_insn_bits_di_b; s->private = (void *)board->id_reg; } if (board->timer_regbase) { s = &dev->subdevices[subdev++]; dev->pacer = comedi_8254_init(dev->iobase + board->timer_regbase, 0, I8254_IO8, 0); if (!dev->pacer) return -ENOMEM; comedi_8254_subdevice_init(s, dev->pacer); } return 0; } static struct comedi_driver adv_pci_dio_driver = { .driver_name = "adv_pci_dio", .module = THIS_MODULE, .auto_attach = pci_dio_auto_attach, .detach = comedi_pci_detach, }; static unsigned long pci_dio_override_cardtype(struct pci_dev *pcidev, unsigned long cardtype) { /* * Change cardtype from TYPE_PCI1753 to TYPE_PCI1753E if expansion * board available. Need to enable PCI device and request the main * registers PCI BAR temporarily to perform the test. */ if (cardtype != TYPE_PCI1753) return cardtype; if (pci_enable_device(pcidev) < 0) return cardtype; if (pci_request_region(pcidev, 2, "adv_pci_dio") == 0) { /* * This test is based on Advantech's "advdaq" driver source * (which declares its module licence as "GPL" although the * driver source does not include a "COPYING" file). */ unsigned long reg = pci_resource_start(pcidev, 2) + 53; outb(0x05, reg); if ((inb(reg) & 0x07) == 0x02) { outb(0x02, reg); if ((inb(reg) & 0x07) == 0x05) cardtype = TYPE_PCI1753E; } pci_release_region(pcidev, 2); } pci_disable_device(pcidev); return cardtype; } static int adv_pci_dio_pci_probe(struct pci_dev *dev, const struct pci_device_id *id) { unsigned long cardtype; cardtype = pci_dio_override_cardtype(dev, id->driver_data); return comedi_pci_auto_config(dev, &adv_pci_dio_driver, cardtype); } static const struct pci_device_id adv_pci_dio_pci_table[] = { { PCI_VDEVICE(ADVANTECH, 0x1730), TYPE_PCI1730 }, { PCI_VDEVICE(ADVANTECH, 0x1733), TYPE_PCI1733 }, { PCI_VDEVICE(ADVANTECH, 0x1734), TYPE_PCI1734 }, { PCI_VDEVICE(ADVANTECH, 0x1735), TYPE_PCI1735 }, { PCI_VDEVICE(ADVANTECH, 0x1736), TYPE_PCI1736 }, { PCI_VDEVICE(ADVANTECH, 0x1739), TYPE_PCI1739 }, { PCI_VDEVICE(ADVANTECH, 0x1750), TYPE_PCI1750 }, { PCI_VDEVICE(ADVANTECH, 0x1751), TYPE_PCI1751 }, { PCI_VDEVICE(ADVANTECH, 0x1752), TYPE_PCI1752 }, { PCI_VDEVICE(ADVANTECH, 0x1753), TYPE_PCI1753 }, { PCI_VDEVICE(ADVANTECH, 0x1754), TYPE_PCI1754 }, { PCI_VDEVICE(ADVANTECH, 0x1756), TYPE_PCI1756 }, { PCI_VDEVICE(ADVANTECH, 0x1761), TYPE_PCI1761 }, { PCI_VDEVICE(ADVANTECH, 0x1762), TYPE_PCI1762 }, { 0 } }; MODULE_DEVICE_TABLE(pci, adv_pci_dio_pci_table); static struct pci_driver adv_pci_dio_pci_driver = { .name = "adv_pci_dio", .id_table = adv_pci_dio_pci_table, .probe = adv_pci_dio_pci_probe, .remove = comedi_pci_auto_unconfig, }; module_comedi_pci_driver(adv_pci_dio_driver, adv_pci_dio_pci_driver); MODULE_AUTHOR("Comedi http://www.comedi.org"); MODULE_DESCRIPTION("Comedi driver for Advantech Digital I/O Cards"); MODULE_LICENSE("GPL");