Version:  2.0.40 2.2.26 2.4.37 2.6.39 3.0 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15

Linux/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;
329                 s->subdev_flags = SDF_READABLE | SDF_CMD_READ;
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 const struct pci_device_id 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");
384 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us