drivers/staging/comedi/drivers/addi_apci_1032.c

   1 /*
   2  * addi_apci_1032.c
   3  * Copyright (C) 2004,2005  ADDI-DATA GmbH for the source code of this module.
   4  * Project manager: Eric Stolz
   5  *
   6  *      ADDI-DATA GmbH
   7  *      Dieselstrasse 3
   8  *      D-77833 Ottersweier
   9  *      Tel: +19(0)7223/9493-0
  10  *      Fax: +49(0)7223/9493-92
  11  *      http://www.addi-data.com
  12  *      info@addi-data.com
  13  *
  14  * This program is free software; you can redistribute it and/or modify it
  15  * under the terms of the GNU General Public License as published by the
  16  * Free Software Foundation; either version 2 of the License, or (at your
  17  * option) any later version.
  18  *
  19  * This program is distributed in the hope that it will be useful, but WITHOUT
  20  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  21  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  22  * more details.
  23  */
  24
  25 #include <linux/module.h>
  26 #include <linux/pci.h>
  27 #include <linux/interrupt.h>
  28
  29 #include "../comedidev.h"
  30 #include "comedi_fc.h"
  31 #include "amcc_s5933.h"
  32
  33 /*
  34  * I/O Register Map
  35  */
  36 #define APCI1032_DI_REG                 0x00
  37 #define APCI1032_MODE1_REG              0x04
  38 #define APCI1032_MODE2_REG              0x08
  39 #define APCI1032_STATUS_REG             0x0c
  40 #define APCI1032_CTRL_REG               0x10
  41 #define APCI1032_CTRL_INT_OR            (0 << 1)
  42 #define APCI1032_CTRL_INT_AND           (1 << 1)
  43 #define APCI1032_CTRL_INT_ENA           (1 << 2)
  44
  45 struct apci1032_private {
  46         unsigned long amcc_iobase;      /* base of AMCC I/O registers */
  47         unsigned int mode1;     /* rising-edge/high level channels */
  48         unsigned int mode2;     /* falling-edge/low level channels */
  49         unsigned int ctrl;      /* interrupt mode OR (edge) . AND (level) */
  50 };
  51
  52 static int apci1032_reset(struct comedi_device *dev)
  53 {
  54         /* disable the interrupts */
  55         outl(0x0, dev->iobase + APCI1032_CTRL_REG);
  56         /* Reset the interrupt status register */
  57         inl(dev->iobase + APCI1032_STATUS_REG);
  58         /* Disable the and/or interrupt */
  59         outl(0x0, dev->iobase + APCI1032_MODE1_REG);
  60         outl(0x0, dev->iobase + APCI1032_MODE2_REG);
  61
  62         return 0;
  63 }
  64
  65 /*
  66  * Change-Of-State (COS) interrupt configuration
  67  *
  68  * Channels 0 to 15 are interruptible. These channels can be configured
  69  * to generate interrupts based on AND/OR logic for the desired channels.
  70  *
  71  *      OR logic
  72  *              - reacts to rising or falling edges
  73  *              - interrupt is generated when any enabled channel
  74  *                meet the desired interrupt condition
  75  *
  76  *      AND logic
  77  *              - reacts to changes in level of the selected inputs
  78  *              - interrupt is generated when all enabled channels
  79  *                meet the desired interrupt condition
  80  *              - after an interrupt, a change in level must occur on
  81  *                the selected inputs to release the IRQ logic
  82  *
  83  * The COS interrupt must be configured before it can be enabled.
  84  *
  85  *      data[0] : INSN_CONFIG_DIGITAL_TRIG
  86  *      data[1] : trigger number (= 0)
  87  *      data[2] : configuration operation:
  88  *                COMEDI_DIGITAL_TRIG_DISABLE = no interrupts
  89  *                COMEDI_DIGITAL_TRIG_ENABLE_EDGES = OR (edge) interrupts
  90  *                COMEDI_DIGITAL_TRIG_ENABLE_LEVELS = AND (level) interrupts
  91  *      data[3] : left-shift for data[4] and data[5]
  92  *      data[4] : rising-edge/high level channels
  93  *      data[5] : falling-edge/low level channels
  94  */
  95 static int apci1032_cos_insn_config(struct comedi_device *dev,
  96                                     struct comedi_subdevice *s,
  97                                     struct comedi_insn *insn,
  98                                     unsigned int *data)
  99 {
 100         struct apci1032_private *devpriv = dev->private;
 101         unsigned int shift, oldmask;
 102
 103         switch (data[0]) {
 104         case INSN_CONFIG_DIGITAL_TRIG:
 105                 if (data[1] != 0)
 106                         return -EINVAL;
 107                 shift = data[3];
 108                 oldmask = (1U << shift) - 1;
 109                 switch (data[2]) {
 110                 case COMEDI_DIGITAL_TRIG_DISABLE:
 111                         devpriv->ctrl = 0;
 112                         devpriv->mode1 = 0;
 113                         devpriv->mode2 = 0;
 114                         apci1032_reset(dev);
 115                         break;
 116                 case COMEDI_DIGITAL_TRIG_ENABLE_EDGES:
 117                         if (devpriv->ctrl != (APCI1032_CTRL_INT_ENA |
 118                                               APCI1032_CTRL_INT_OR)) {
 119                                 /* switching to 'OR' mode */
 120                                 devpriv->ctrl = APCI1032_CTRL_INT_ENA |
 121                                                 APCI1032_CTRL_INT_OR;
 122                                 /* wipe old channels */
 123                                 devpriv->mode1 = 0;
 124                                 devpriv->mode2 = 0;
 125                         } else {
 126                                 /* preserve unspecified channels */
 127                                 devpriv->mode1 &= oldmask;
 128                                 devpriv->mode2 &= oldmask;
 129                         }
 130                         /* configure specified channels */
 131                         devpriv->mode1 |= data[4] << shift;
 132                         devpriv->mode2 |= data[5] << shift;
 133                         break;
 134                 case COMEDI_DIGITAL_TRIG_ENABLE_LEVELS:
 135                         if (devpriv->ctrl != (APCI1032_CTRL_INT_ENA |
 136                                               APCI1032_CTRL_INT_AND)) {
 137                                 /* switching to 'AND' mode */
 138                                 devpriv->ctrl = APCI1032_CTRL_INT_ENA |
 139                                                 APCI1032_CTRL_INT_AND;
 140                                 /* wipe old channels */
 141                                 devpriv->mode1 = 0;
 142                                 devpriv->mode2 = 0;
 143                         } else {
 144                                 /* preserve unspecified channels */
 145                                 devpriv->mode1 &= oldmask;
 146                                 devpriv->mode2 &= oldmask;
 147                         }
 148                         /* configure specified channels */
 149                         devpriv->mode1 |= data[4] << shift;
 150                         devpriv->mode2 |= data[5] << shift;
 151                         break;
 152                 default:
 153                         return -EINVAL;
 154                 }
 155                 break;
 156         default:
 157                 return -EINVAL;
 158         }
 159
 160         return insn->n;
 161 }
 162
 163 static int apci1032_cos_insn_bits(struct comedi_device *dev,
 164                                   struct comedi_subdevice *s,
 165                                   struct comedi_insn *insn,
 166                                   unsigned int *data)
 167 {
 168         data[1] = s->state;
 169
 170         return 0;
 171 }
 172
 173 static int apci1032_cos_cmdtest(struct comedi_device *dev,
 174                                 struct comedi_subdevice *s,
 175                                 struct comedi_cmd *cmd)
 176 {
 177         int err = 0;
 178
 179         /* Step 1 : check if triggers are trivially valid */
 180
 181         err |= cfc_check_trigger_src(&cmd->start_src, TRIG_NOW);
 182         err |= cfc_check_trigger_src(&cmd->scan_begin_src, TRIG_EXT);
 183         err |= cfc_check_trigger_src(&cmd->convert_src, TRIG_FOLLOW);
 184         err |= cfc_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT);
 185         err |= cfc_check_trigger_src(&cmd->stop_src, TRIG_NONE);
 186
 187         if (err)
 188                 return 1;
 189
 190         /* Step 2a : make sure trigger sources are unique */
 191         /* Step 2b : and mutually compatible */
 192
 193         if (err)
 194                 return 2;
 195
 196         /* Step 3: check if arguments are trivially valid */
 197
 198         err |= cfc_check_trigger_arg_is(&cmd->start_arg, 0);
 199         err |= cfc_check_trigger_arg_is(&cmd->scan_begin_arg, 0);
 200         err |= cfc_check_trigger_arg_is(&cmd->convert_arg, 0);
 201         err |= cfc_check_trigger_arg_is(&cmd->scan_end_arg, 1);
 202         err |= cfc_check_trigger_arg_is(&cmd->stop_arg, 0);
 203
 204         if (err)
 205                 return 3;
 206
 207         /* step 4: ignored */
 208
 209         if (err)
 210                 return 4;
 211
 212         return 0;
 213 }
 214
 215 /*
 216  * Change-Of-State (COS) 'do_cmd' operation
 217  *
 218  * Enable the COS interrupt as configured by apci1032_cos_insn_config().
 219  */
 220 static int apci1032_cos_cmd(struct comedi_device *dev,
 221                             struct comedi_subdevice *s)
 222 {
 223         struct apci1032_private *devpriv = dev->private;
 224
 225         if (!devpriv->ctrl) {
 226                 dev_warn(dev->class_dev,
 227                         "Interrupts disabled due to mode configuration!\n");
 228                 return -EINVAL;
 229         }
 230
 231         outl(devpriv->mode1, dev->iobase + APCI1032_MODE1_REG);
 232         outl(devpriv->mode2, dev->iobase + APCI1032_MODE2_REG);
 233         outl(devpriv->ctrl, dev->iobase + APCI1032_CTRL_REG);
 234
 235         return 0;
 236 }
 237
 238 static int apci1032_cos_cancel(struct comedi_device *dev,
 239                                struct comedi_subdevice *s)
 240 {
 241         return apci1032_reset(dev);
 242 }
 243
 244 static irqreturn_t apci1032_interrupt(int irq, void *d)
 245 {
 246         struct comedi_device *dev = d;
 247         struct apci1032_private *devpriv = dev->private;
 248         struct comedi_subdevice *s = dev->read_subdev;
 249         unsigned int ctrl;
 250
 251         /* check interrupt is from this device */
 252         if ((inl(devpriv->amcc_iobase + AMCC_OP_REG_INTCSR) &
 253              INTCSR_INTR_ASSERTED) == 0)
 254                 return IRQ_NONE;
 255
 256         /* check interrupt is enabled */
 257         ctrl = inl(dev->iobase + APCI1032_CTRL_REG);
 258         if ((ctrl & APCI1032_CTRL_INT_ENA) == 0)
 259                 return IRQ_HANDLED;
 260
 261         /* disable the interrupt */
 262         outl(ctrl & ~APCI1032_CTRL_INT_ENA, dev->iobase + APCI1032_CTRL_REG);
 263
 264         s->state = inl(dev->iobase + APCI1032_STATUS_REG) & 0xffff;
 265         comedi_buf_put(s->async, s->state);
 266         s->async->events |= COMEDI_CB_BLOCK | COMEDI_CB_EOS;
 267         comedi_event(dev, s);
 268
 269         /* enable the interrupt */
 270         outl(ctrl, dev->iobase + APCI1032_CTRL_REG);
 271
 272         return IRQ_HANDLED;
 273 }
 274
 275 static int apci1032_di_insn_bits(struct comedi_device *dev,
 276                                  struct comedi_subdevice *s,
 277                                  struct comedi_insn *insn,
 278                                  unsigned int *data)
 279 {
 280         data[1] = inl(dev->iobase + APCI1032_DI_REG);
 281
 282         return insn->n;
 283 }
 284
 285 static int apci1032_auto_attach(struct comedi_device *dev,
 286                                           unsigned long context_unused)
 287 {
 288         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
 289         struct apci1032_private *devpriv;
 290         struct comedi_subdevice *s;
 291         int ret;
 292
 293         devpriv = comedi_alloc_devpriv(dev, sizeof(*devpriv));
 294         if (!devpriv)
 295                 return -ENOMEM;
 296
 297         ret = comedi_pci_enable(dev);
 298         if (ret)
 299                 return ret;
 300
 301         devpriv->amcc_iobase = pci_resource_start(pcidev, 0);
 302         dev->iobase = pci_resource_start(pcidev, 1);
 303         apci1032_reset(dev);
 304         if (pcidev->irq > 0) {
 305                 ret = request_irq(pcidev->irq, apci1032_interrupt, IRQF_SHARED,
 306                                   dev->board_name, dev);
 307                 if (ret == 0)
 308                         dev->irq = pcidev->irq;
 309         }
 310
 311         ret = comedi_alloc_subdevices(dev, 2);
 312         if (ret)
 313                 return ret;
 314
 315         /*  Allocate and Initialise DI Subdevice Structures */
 316         s = &dev->subdevices[0];
 317         s->type         = COMEDI_SUBD_DI;
 318         s->subdev_flags = SDF_READABLE;
 319         s->n_chan       = 32;
 320         s->maxdata      = 1;
 321         s->range_table  = &range_digital;
 322         s->insn_bits    = apci1032_di_insn_bits;
 323
 324         /* Change-Of-State (COS) interrupt subdevice */
 325         s = &dev->subdevices[1];
 326         if (dev->irq) {
 327                 dev->read_subdev = s;
 328                 s->type         = COMEDI_SUBD_DI | SDF_CMD_READ;
 329                 s->subdev_flags = SDF_READABLE;
 330                 s->n_chan       = 1;
 331                 s->maxdata      = 1;
 332                 s->range_table  = &range_digital;
 333                 s->insn_config  = apci1032_cos_insn_config;
 334                 s->insn_bits    = apci1032_cos_insn_bits;
 335                 s->do_cmdtest   = apci1032_cos_cmdtest;
 336                 s->do_cmd       = apci1032_cos_cmd;
 337                 s->cancel       = apci1032_cos_cancel;
 338         } else {
 339                 s->type         = COMEDI_SUBD_UNUSED;
 340         }
 341
 342         return 0;
 343 }
 344
 345 static void apci1032_detach(struct comedi_device *dev)
 346 {
 347         if (dev->iobase)
 348                 apci1032_reset(dev);
 349         if (dev->irq)
 350                 free_irq(dev->irq, dev);
 351         comedi_pci_disable(dev);
 352 }
 353
 354 static struct comedi_driver apci1032_driver = {
 355         .driver_name    = "addi_apci_1032",
 356         .module         = THIS_MODULE,
 357         .auto_attach    = apci1032_auto_attach,
 358         .detach         = apci1032_detach,
 359 };
 360
 361 static int apci1032_pci_probe(struct pci_dev *dev,
 362                               const struct pci_device_id *id)
 363 {
 364         return comedi_pci_auto_config(dev, &apci1032_driver, id->driver_data);
 365 }
 366
 367 static DEFINE_PCI_DEVICE_TABLE(apci1032_pci_table) = {
 368         { PCI_DEVICE(PCI_VENDOR_ID_ADDIDATA, 0x1003) },
 369         { 0 }
 370 };
 371 MODULE_DEVICE_TABLE(pci, apci1032_pci_table);
 372
 373 static struct pci_driver apci1032_pci_driver = {
 374         .name           = "addi_apci_1032",
 375         .id_table       = apci1032_pci_table,
 376         .probe          = apci1032_pci_probe,
 377         .remove         = comedi_pci_auto_unconfig,
 378 };
 379 module_comedi_pci_driver(apci1032_driver, apci1032_pci_driver);
 380
 381 MODULE_AUTHOR("Comedi http://www.comedi.org");
 382 MODULE_DESCRIPTION("Comedi low-level driver");
 383 MODULE_LICENSE("GPL");