1d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten/* 2d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * addi_apci_2032.c 3d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * Copyright (C) 2004,2005 ADDI-DATA GmbH for the source code of this module. 4d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * Project manager: Eric Stolz 5d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * 6d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * ADDI-DATA GmbH 7d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * Dieselstrasse 3 8d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * D-77833 Ottersweier 9d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * Tel: +19(0)7223/9493-0 10d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * Fax: +49(0)7223/9493-92 11d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * http://www.addi-data.com 12d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * info@addi-data.com 13d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * 14d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * This program is free software; you can redistribute it and/or modify it 15d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * under the terms of the GNU General Public License as published by the 16d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * Free Software Foundation; either version 2 of the License, or (at your 17d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * option) any later version. 18d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * 19d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * This program is distributed in the hope that it will be useful, but WITHOUT 20d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 21d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 22d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * more details. 23d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten */ 24d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten 25ce157f8032bbd46d9427034c335b0afd751da25dH Hartley Sweeten#include <linux/module.h> 2633782dd5edf8db3cdb7c81a3523bf743dd0209b7H Hartley Sweeten#include <linux/pci.h> 27abac8b54a353b9a1ac7d09ff790812655f618896H Hartley Sweeten#include <linux/interrupt.h> 28bcc27c82bac2622e352c732a0bda49651e1799b3Geert Uytterhoeven#include <linux/slab.h> 29abac8b54a353b9a1ac7d09ff790812655f618896H Hartley Sweeten 303d41c44370a9a1e78e53c9997289347ec97d46eeH Hartley Sweeten#include "../comedidev.h" 315b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten#include "addi_watchdog.h" 323d41c44370a9a1e78e53c9997289347ec97d46eeH Hartley Sweeten#include "comedi_fc.h" 333d41c44370a9a1e78e53c9997289347ec97d46eeH Hartley Sweeten 34d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten/* 35d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten * PCI bar 1 I/O Register map 36d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten */ 377180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten#define APCI2032_DO_REG 0x00 387180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten#define APCI2032_INT_CTRL_REG 0x04 397180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten#define APCI2032_INT_CTRL_VCC_ENA (1 << 0) 407180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten#define APCI2032_INT_CTRL_CC_ENA (1 << 1) 417180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten#define APCI2032_INT_STATUS_REG 0x08 427180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten#define APCI2032_INT_STATUS_VCC (1 << 0) 437180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten#define APCI2032_INT_STATUS_CC (1 << 1) 447180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten#define APCI2032_STATUS_REG 0x0c 457180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten#define APCI2032_STATUS_IRQ (1 << 0) 467180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten#define APCI2032_WDOG_REG 0x10 4723fb174746057b6d13539735241390eb9e3fdb46H Hartley Sweeten 485c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbottstruct apci2032_int_private { 495c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spinlock_t spinlock; 50215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott unsigned int stop_count; 515c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott bool active; 525c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned char enabled_isns; 535c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott}; 545c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 55d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweetenstatic int apci2032_do_insn_bits(struct comedi_device *dev, 56d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten struct comedi_subdevice *s, 57d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten struct comedi_insn *insn, 58d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten unsigned int *data) 59d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten{ 607180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten s->state = inl(dev->iobase + APCI2032_DO_REG); 61d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten 6297f4289ad08cffe55de06d4ac4f89ac540450aeeH Hartley Sweeten if (comedi_dio_update_state(s, data)) 637180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten outl(s->state, dev->iobase + APCI2032_DO_REG); 64d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten 65d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten data[1] = s->state; 66d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten 67d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten return insn->n; 68d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten} 69d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten 7005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic int apci2032_int_insn_bits(struct comedi_device *dev, 7105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s, 7205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_insn *insn, 7305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten unsigned int *data) 74b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten{ 75b652bd83a0528c43e935cb6f2f8df024b7a85c5eIan Abbott data[1] = inl(dev->iobase + APCI2032_INT_STATUS_REG) & 3; 7605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return insn->n; 7705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten} 78b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 795c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbottstatic void apci2032_int_stop(struct comedi_device *dev, 805c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct comedi_subdevice *s) 815c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott{ 825c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv = s->private; 835c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 845c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott subpriv->active = false; 855c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott subpriv->enabled_isns = 0; 865c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott outl(0x0, dev->iobase + APCI2032_INT_CTRL_REG); 875c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott} 885c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 8905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic int apci2032_int_cmdtest(struct comedi_device *dev, 9005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s, 9105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_cmd *cmd) 9205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten{ 9305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten int err = 0; 94b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 9505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Step 1 : check if triggers are trivially valid */ 96b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 9705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten err |= cfc_check_trigger_src(&cmd->start_src, TRIG_NOW); 985c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott err |= cfc_check_trigger_src(&cmd->scan_begin_src, TRIG_EXT); 995c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott err |= cfc_check_trigger_src(&cmd->convert_src, TRIG_NOW); 10005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten err |= cfc_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT); 101215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott err |= cfc_check_trigger_src(&cmd->stop_src, TRIG_COUNT | TRIG_NONE); 102b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 10305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (err) 10405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 1; 105b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 10605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Step 2a : make sure trigger sources are unique */ 107215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott err |= cfc_check_trigger_is_unique(cmd->stop_src); 108215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott 10905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Step 2b : and mutually compatible */ 11005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 11105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (err) 11205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 2; 11305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 11405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Step 3: check if arguments are trivially valid */ 11505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 11605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten err |= cfc_check_trigger_arg_is(&cmd->start_arg, 0); 1175c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott err |= cfc_check_trigger_arg_is(&cmd->scan_begin_arg, 0); 11805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten err |= cfc_check_trigger_arg_is(&cmd->convert_arg, 0); 1195c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott err |= cfc_check_trigger_arg_is(&cmd->scan_end_arg, cmd->chanlist_len); 12052c22b803e1b0259adddb0bd2153674ddb2da0d3H Hartley Sweeten if (cmd->stop_src == TRIG_COUNT) 12152c22b803e1b0259adddb0bd2153674ddb2da0d3H Hartley Sweeten err |= cfc_check_trigger_arg_min(&cmd->stop_arg, 1); 12252c22b803e1b0259adddb0bd2153674ddb2da0d3H Hartley Sweeten else /* TRIG_NONE */ 123215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott err |= cfc_check_trigger_arg_is(&cmd->stop_arg, 0); 12405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 12505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (err) 12605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 3; 12705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 128b3cdebbfe22e26c3004eaec91fca1d1851b248d0H Hartley Sweeten /* Step 4: fix up any arguments */ 12905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 130b3cdebbfe22e26c3004eaec91fca1d1851b248d0H Hartley Sweeten /* Step 5: check channel list if it exists */ 13105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 13205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 0; 133b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten} 134b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 13505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic int apci2032_int_cmd(struct comedi_device *dev, 13605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s) 137d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten{ 13805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_cmd *cmd = &s->async->cmd; 1395c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv = s->private; 1405c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned char enabled_isns; 1415c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned int n; 1425c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned long flags; 1435c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 1445c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott enabled_isns = 0; 1455c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott for (n = 0; n < cmd->chanlist_len; n++) 1465c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott enabled_isns |= 1 << CR_CHAN(cmd->chanlist[n]); 14705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 1485c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock_irqsave(&subpriv->spinlock, flags); 14905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 150103e280141ecd19b429567af9e9931817dfacd2aH Hartley Sweeten subpriv->enabled_isns = enabled_isns; 151103e280141ecd19b429567af9e9931817dfacd2aH Hartley Sweeten subpriv->stop_count = cmd->stop_arg; 152103e280141ecd19b429567af9e9931817dfacd2aH Hartley Sweeten subpriv->active = true; 153103e280141ecd19b429567af9e9931817dfacd2aH Hartley Sweeten outl(enabled_isns, dev->iobase + APCI2032_INT_CTRL_REG); 154103e280141ecd19b429567af9e9931817dfacd2aH Hartley Sweeten 155103e280141ecd19b429567af9e9931817dfacd2aH Hartley Sweeten spin_unlock_irqrestore(&subpriv->spinlock, flags); 156215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott 15705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 0; 158d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten} 1597180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten 16005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic int apci2032_int_cancel(struct comedi_device *dev, 16105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s) 162d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten{ 1635c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv = s->private; 1645c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned long flags; 1655c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 1665c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock_irqsave(&subpriv->spinlock, flags); 1675c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (subpriv->active) 1685c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott apci2032_int_stop(dev, s); 1695c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_unlock_irqrestore(&subpriv->spinlock, flags); 170d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten 17105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 0; 172d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten} 173317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten 17405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic irqreturn_t apci2032_interrupt(int irq, void *d) 17525adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 17605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_device *dev = d; 17705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s = dev->read_subdev; 17856e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten struct comedi_cmd *cmd = &s->async->cmd; 1795c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv; 18005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten unsigned int val; 1815c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott bool do_event = false; 18205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 1830774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott if (!dev->attached) 1840774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott return IRQ_NONE; 1850774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott 18605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Check if VCC OR CC interrupt has occurred */ 18705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten val = inl(dev->iobase + APCI2032_STATUS_REG) & APCI2032_STATUS_IRQ; 18805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (!val) 18905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return IRQ_NONE; 19005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 1915c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott subpriv = s->private; 1925c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock(&subpriv->spinlock); 1935c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 194b652bd83a0528c43e935cb6f2f8df024b7a85c5eIan Abbott val = inl(dev->iobase + APCI2032_INT_STATUS_REG) & 3; 195ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott /* Disable triggered interrupt sources. */ 196ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott outl(~val & 3, dev->iobase + APCI2032_INT_CTRL_REG); 197ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott /* 198ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott * Note: We don't reenable the triggered interrupt sources because they 199ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott * are level-sensitive, hardware error status interrupt sources and 200ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott * they'd keep triggering interrupts repeatedly. 201ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott */ 20205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 2035c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (subpriv->active && (val & subpriv->enabled_isns) != 0) { 20456e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten unsigned short bits = 0; 20556e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten int i; 2065c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 2075c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott /* Bits in scan data correspond to indices in channel list. */ 20856e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten for (i = 0; i < cmd->chanlist_len; i++) { 20956e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten unsigned int chan = CR_CHAN(cmd->chanlist[i]); 21056e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten 21156e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten if (val & (1 << chan)) 21256e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten bits |= (1 << i); 21356e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten } 2145c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 2153672effdeae5395d661a2103f69082146ef949fcIan Abbott if (comedi_buf_put(s, bits)) { 2165c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->async->events |= COMEDI_CB_BLOCK | COMEDI_CB_EOS; 21756e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten if (cmd->stop_src == TRIG_COUNT && 218215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott subpriv->stop_count > 0) { 219215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott subpriv->stop_count--; 220215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott if (subpriv->stop_count == 0) { 221215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott /* end of acquisition */ 222215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott s->async->events |= COMEDI_CB_EOA; 223215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott apci2032_int_stop(dev, s); 224215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott } 225215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott } 2265c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott } else { 2275c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott apci2032_int_stop(dev, s); 2285c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->async->events |= COMEDI_CB_OVERFLOW; 2295c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott } 2305c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott do_event = true; 2315c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott } 2325c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 2335c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_unlock(&subpriv->spinlock); 2345c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (do_event) 2355c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott comedi_event(dev, s); 23605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 23705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return IRQ_HANDLED; 23825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 23925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 240791c9792ff2d12a02f0ab1c47fd7f7a94828b05bH Hartley Sweetenstatic int apci2032_reset(struct comedi_device *dev) 24125adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 2427180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten outl(0x0, dev->iobase + APCI2032_DO_REG); 2437180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten outl(0x0, dev->iobase + APCI2032_INT_CTRL_REG); 2445b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten 2455b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten addi_watchdog_reset(dev->iobase + APCI2032_WDOG_REG); 24625adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 24725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return 0; 24825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 24925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 25025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweetenstatic int apci2032_auto_attach(struct comedi_device *dev, 25125adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten unsigned long context_unused) 25225adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 25325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten struct pci_dev *pcidev = comedi_to_pci_dev(dev); 25425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten struct comedi_subdevice *s; 2550c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten int ret; 25625adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 257818f569fe930c5b8a05d1a44ece3c63c99c13c88H Hartley Sweeten ret = comedi_pci_enable(dev); 25825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (ret) 25925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return ret; 26070ff406599a5debfa6e5ef243e5e093f63a9ed69H Hartley Sweeten dev->iobase = pci_resource_start(pcidev, 1); 2610774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott apci2032_reset(dev); 26225adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 26325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (pcidev->irq > 0) { 26405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten ret = request_irq(pcidev->irq, apci2032_interrupt, 26505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten IRQF_SHARED, dev->board_name, dev); 26625adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (ret == 0) 26725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten dev->irq = pcidev->irq; 26825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten } 26925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 27005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten ret = comedi_alloc_subdevices(dev, 3); 27125adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (ret) 27225adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return ret; 27325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 2740c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten /* Initialize the digital output subdevice */ 27525adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten s = &dev->subdevices[0]; 276cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->type = COMEDI_SUBD_DO; 277cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->subdev_flags = SDF_WRITEABLE; 278cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->n_chan = 32; 279cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->maxdata = 1; 280cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->range_table = &range_digital; 281cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->insn_bits = apci2032_do_insn_bits; 28225adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 2830c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten /* Initialize the watchdog subdevice */ 2840c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten s = &dev->subdevices[1]; 2855b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten ret = addi_watchdog_init(s, dev->iobase + APCI2032_WDOG_REG); 2865b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten if (ret) 2875b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten return ret; 28825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 28905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Initialize the interrupt subdevice */ 29005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s = &dev->subdevices[2]; 2915f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->type = COMEDI_SUBD_DI; 2925f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->subdev_flags = SDF_READABLE; 2935f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->n_chan = 2; 2945f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->maxdata = 1; 2955f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->range_table = &range_digital; 2965f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->insn_bits = apci2032_int_insn_bits; 29705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (dev->irq) { 2985c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv; 2995c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 30005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten dev->read_subdev = s; 3015c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott subpriv = kzalloc(sizeof(*subpriv), GFP_KERNEL); 3025c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (!subpriv) 3035c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott return -ENOMEM; 3045c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock_init(&subpriv->spinlock); 3055c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->private = subpriv; 306b82fe57c4d059a8ff1190ead1693d66b868353b2Ian Abbott s->subdev_flags = SDF_READABLE | SDF_CMD_READ; 3075c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->len_chanlist = 2; 30805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s->do_cmdtest = apci2032_int_cmdtest; 30905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s->do_cmd = apci2032_int_cmd; 31005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s->cancel = apci2032_int_cancel; 31105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten } 31205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 31325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return 0; 31425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 31525adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 31625adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweetenstatic void apci2032_detach(struct comedi_device *dev) 31725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 318dce10abc499ec5e53ea01683fdb2181f24d6776dH Hartley Sweeten if (dev->iobase) 319dce10abc499ec5e53ea01683fdb2181f24d6776dH Hartley Sweeten apci2032_reset(dev); 320aac307f9dd5ce1fe651140a036ab4b0a0571b54aH Hartley Sweeten comedi_pci_detach(dev); 3215c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (dev->read_subdev) 3225c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott kfree(dev->read_subdev->private); 32325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 32425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 32520a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweetenstatic struct comedi_driver apci2032_driver = { 32620a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .driver_name = "addi_apci_2032", 32720a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .module = THIS_MODULE, 32825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten .auto_attach = apci2032_auto_attach, 32925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten .detach = apci2032_detach, 33020a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten}; 33120a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten 332a690b7e535f2f97a3a05ee570715abeb60a8910fBill Pembertonstatic int apci2032_pci_probe(struct pci_dev *dev, 333b8f4ac237e382accd4b30c75043939f7ed9e79a6H Hartley Sweeten const struct pci_device_id *id) 33420a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten{ 335b8f4ac237e382accd4b30c75043939f7ed9e79a6H Hartley Sweeten return comedi_pci_auto_config(dev, &apci2032_driver, id->driver_data); 33620a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten} 33720a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten 33841e043fcfa2236bb2c4a8335eb09f4c8cee224b3Jingoo Hanstatic const struct pci_device_id apci2032_pci_table[] = { 339317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten { PCI_DEVICE(PCI_VENDOR_ID_ADDIDATA, 0x1004) }, 340317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten { 0 } 341317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten}; 34220a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley SweetenMODULE_DEVICE_TABLE(pci, apci2032_pci_table); 343317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten 34420a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweetenstatic struct pci_driver apci2032_pci_driver = { 34520a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .name = "addi_apci_2032", 34620a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .id_table = apci2032_pci_table, 34720a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .probe = apci2032_pci_probe, 3489901a4d75d007686e8f6473189cafc4b216b7449Peter Huewe .remove = comedi_pci_auto_unconfig, 34920a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten}; 35020a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweetenmodule_comedi_pci_driver(apci2032_driver, apci2032_pci_driver); 35190f703d30dd3e0c16ff80f35e34e511385a05ad5Arun Thomas 35290f703d30dd3e0c16ff80f35e34e511385a05ad5Arun ThomasMODULE_AUTHOR("Comedi http://www.comedi.org"); 353b5ebcaa8d3405e14ca431257fd6c6cdc30df13c5Georg GastMODULE_DESCRIPTION("ADDI-DATA APCI-2032, 32 channel DO boards"); 35490f703d30dd3e0c16ff80f35e34e511385a05ad5Arun ThomasMODULE_LICENSE("GPL"); 355