addi_apci_2032.c revision aac307f9dd5ce1fe651140a036ab4b0a0571b54a
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 89215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbottstatic bool apci2032_int_start(struct comedi_device *dev, 90215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott struct comedi_subdevice *s, 91215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott unsigned char enabled_isns) 92215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott{ 93215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott struct apci2032_int_private *subpriv = s->private; 94215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott struct comedi_cmd *cmd = &s->async->cmd; 95215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott bool do_event; 96215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott 97215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott subpriv->enabled_isns = enabled_isns; 98215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott subpriv->stop_count = cmd->stop_arg; 99215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott if (cmd->stop_src == TRIG_COUNT && subpriv->stop_count == 0) { 100215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott /* An empty acquisition! */ 101215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott s->async->events |= COMEDI_CB_EOA; 102215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott subpriv->active = false; 103215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott do_event = true; 104215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott } else { 105215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott subpriv->active = true; 106215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott outl(enabled_isns, dev->iobase + APCI2032_INT_CTRL_REG); 107215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott do_event = false; 108215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott } 109215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott 110215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott return do_event; 111215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott} 112215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott 11305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic int apci2032_int_cmdtest(struct comedi_device *dev, 11405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s, 11505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_cmd *cmd) 11605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten{ 11705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten int err = 0; 118b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 11905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Step 1 : check if triggers are trivially valid */ 120b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 12105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten err |= cfc_check_trigger_src(&cmd->start_src, TRIG_NOW); 1225c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott err |= cfc_check_trigger_src(&cmd->scan_begin_src, TRIG_EXT); 1235c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott err |= cfc_check_trigger_src(&cmd->convert_src, TRIG_NOW); 12405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten err |= cfc_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT); 125215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott err |= cfc_check_trigger_src(&cmd->stop_src, TRIG_COUNT | TRIG_NONE); 126b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 12705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (err) 12805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 1; 129b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 13005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Step 2a : make sure trigger sources are unique */ 131215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott err |= cfc_check_trigger_is_unique(cmd->stop_src); 132215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott 13305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Step 2b : and mutually compatible */ 13405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 13505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (err) 13605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 2; 13705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 13805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Step 3: check if arguments are trivially valid */ 13905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 14005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten err |= cfc_check_trigger_arg_is(&cmd->start_arg, 0); 1415c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott err |= cfc_check_trigger_arg_is(&cmd->scan_begin_arg, 0); 14205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten err |= cfc_check_trigger_arg_is(&cmd->convert_arg, 0); 1435c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott err |= cfc_check_trigger_arg_is(&cmd->scan_end_arg, cmd->chanlist_len); 144215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott if (cmd->stop_src == TRIG_NONE) 145215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott err |= cfc_check_trigger_arg_is(&cmd->stop_arg, 0); 14605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 14705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (err) 14805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 3; 14905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 150b3cdebbfe22e26c3004eaec91fca1d1851b248d0H Hartley Sweeten /* Step 4: fix up any arguments */ 15105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 152b3cdebbfe22e26c3004eaec91fca1d1851b248d0H Hartley Sweeten /* Step 5: check channel list if it exists */ 15305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 15405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 0; 155b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten} 156b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 15705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic int apci2032_int_cmd(struct comedi_device *dev, 15805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s) 159d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten{ 16005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_cmd *cmd = &s->async->cmd; 1615c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv = s->private; 1625c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned char enabled_isns; 1635c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned int n; 1645c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned long flags; 165215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott bool do_event; 1665c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 1675c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott enabled_isns = 0; 1685c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott for (n = 0; n < cmd->chanlist_len; n++) 1695c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott enabled_isns |= 1 << CR_CHAN(cmd->chanlist[n]); 17005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 1715c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock_irqsave(&subpriv->spinlock, flags); 172215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott do_event = apci2032_int_start(dev, s, enabled_isns); 1735c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_unlock_irqrestore(&subpriv->spinlock, flags); 17405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 175215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott if (do_event) 176215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott comedi_event(dev, s); 177215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott 17805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 0; 179d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten} 1807180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten 18105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic int apci2032_int_cancel(struct comedi_device *dev, 18205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s) 183d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten{ 1845c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv = s->private; 1855c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned long flags; 1865c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 1875c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock_irqsave(&subpriv->spinlock, flags); 1885c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (subpriv->active) 1895c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott apci2032_int_stop(dev, s); 1905c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_unlock_irqrestore(&subpriv->spinlock, flags); 191d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten 19205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 0; 193d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten} 194317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten 19505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic irqreturn_t apci2032_interrupt(int irq, void *d) 19625adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 19705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_device *dev = d; 19805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s = dev->read_subdev; 19956e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten struct comedi_cmd *cmd = &s->async->cmd; 2005c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv; 20105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten unsigned int val; 2025c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott bool do_event = false; 20305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 2040774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott if (!dev->attached) 2050774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott return IRQ_NONE; 2060774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott 20705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Check if VCC OR CC interrupt has occurred */ 20805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten val = inl(dev->iobase + APCI2032_STATUS_REG) & APCI2032_STATUS_IRQ; 20905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (!val) 21005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return IRQ_NONE; 21105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 2125c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott subpriv = s->private; 2135c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock(&subpriv->spinlock); 2145c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 215b652bd83a0528c43e935cb6f2f8df024b7a85c5eIan Abbott val = inl(dev->iobase + APCI2032_INT_STATUS_REG) & 3; 216ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott /* Disable triggered interrupt sources. */ 217ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott outl(~val & 3, dev->iobase + APCI2032_INT_CTRL_REG); 218ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott /* 219ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott * Note: We don't reenable the triggered interrupt sources because they 220ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott * are level-sensitive, hardware error status interrupt sources and 221ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott * they'd keep triggering interrupts repeatedly. 222ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott */ 22305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 2245c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (subpriv->active && (val & subpriv->enabled_isns) != 0) { 22556e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten unsigned short bits = 0; 22656e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten int i; 2275c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 2285c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott /* Bits in scan data correspond to indices in channel list. */ 22956e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten for (i = 0; i < cmd->chanlist_len; i++) { 23056e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten unsigned int chan = CR_CHAN(cmd->chanlist[i]); 23156e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten 23256e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten if (val & (1 << chan)) 23356e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten bits |= (1 << i); 23456e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten } 2355c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 2363672effdeae5395d661a2103f69082146ef949fcIan Abbott if (comedi_buf_put(s, bits)) { 2375c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->async->events |= COMEDI_CB_BLOCK | COMEDI_CB_EOS; 23856e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten if (cmd->stop_src == TRIG_COUNT && 239215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott subpriv->stop_count > 0) { 240215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott subpriv->stop_count--; 241215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott if (subpriv->stop_count == 0) { 242215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott /* end of acquisition */ 243215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott s->async->events |= COMEDI_CB_EOA; 244215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott apci2032_int_stop(dev, s); 245215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott } 246215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott } 2475c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott } else { 2485c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott apci2032_int_stop(dev, s); 2495c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->async->events |= COMEDI_CB_OVERFLOW; 2505c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott } 2515c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott do_event = true; 2525c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott } 2535c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 2545c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_unlock(&subpriv->spinlock); 2555c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (do_event) 2565c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott comedi_event(dev, s); 25705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 25805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return IRQ_HANDLED; 25925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 26025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 261791c9792ff2d12a02f0ab1c47fd7f7a94828b05bH Hartley Sweetenstatic int apci2032_reset(struct comedi_device *dev) 26225adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 2637180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten outl(0x0, dev->iobase + APCI2032_DO_REG); 2647180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten outl(0x0, dev->iobase + APCI2032_INT_CTRL_REG); 2655b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten 2665b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten addi_watchdog_reset(dev->iobase + APCI2032_WDOG_REG); 26725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 26825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return 0; 26925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 27025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 27125adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweetenstatic int apci2032_auto_attach(struct comedi_device *dev, 27225adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten unsigned long context_unused) 27325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 27425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten struct pci_dev *pcidev = comedi_to_pci_dev(dev); 27525adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten struct comedi_subdevice *s; 2760c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten int ret; 27725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 278818f569fe930c5b8a05d1a44ece3c63c99c13c88H Hartley Sweeten ret = comedi_pci_enable(dev); 27925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (ret) 28025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return ret; 28170ff406599a5debfa6e5ef243e5e093f63a9ed69H Hartley Sweeten dev->iobase = pci_resource_start(pcidev, 1); 2820774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott apci2032_reset(dev); 28325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 28425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (pcidev->irq > 0) { 28505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten ret = request_irq(pcidev->irq, apci2032_interrupt, 28605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten IRQF_SHARED, dev->board_name, dev); 28725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (ret == 0) 28825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten dev->irq = pcidev->irq; 28925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten } 29025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 29105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten ret = comedi_alloc_subdevices(dev, 3); 29225adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (ret) 29325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return ret; 29425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 2950c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten /* Initialize the digital output subdevice */ 29625adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten s = &dev->subdevices[0]; 297cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->type = COMEDI_SUBD_DO; 298cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->subdev_flags = SDF_WRITEABLE; 299cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->n_chan = 32; 300cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->maxdata = 1; 301cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->range_table = &range_digital; 302cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->insn_bits = apci2032_do_insn_bits; 30325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 3040c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten /* Initialize the watchdog subdevice */ 3050c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten s = &dev->subdevices[1]; 3065b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten ret = addi_watchdog_init(s, dev->iobase + APCI2032_WDOG_REG); 3075b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten if (ret) 3085b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten return ret; 30925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 31005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Initialize the interrupt subdevice */ 31105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s = &dev->subdevices[2]; 3125f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->type = COMEDI_SUBD_DI; 3135f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->subdev_flags = SDF_READABLE; 3145f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->n_chan = 2; 3155f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->maxdata = 1; 3165f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->range_table = &range_digital; 3175f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->insn_bits = apci2032_int_insn_bits; 31805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (dev->irq) { 3195c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv; 3205c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 32105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten dev->read_subdev = s; 3225c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott subpriv = kzalloc(sizeof(*subpriv), GFP_KERNEL); 3235c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (!subpriv) 3245c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott return -ENOMEM; 3255c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock_init(&subpriv->spinlock); 3265c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->private = subpriv; 327b82fe57c4d059a8ff1190ead1693d66b868353b2Ian Abbott s->subdev_flags = SDF_READABLE | SDF_CMD_READ; 3285c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->len_chanlist = 2; 32905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s->do_cmdtest = apci2032_int_cmdtest; 33005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s->do_cmd = apci2032_int_cmd; 33105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s->cancel = apci2032_int_cancel; 33205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten } 33305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 33425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return 0; 33525adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 33625adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 33725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweetenstatic void apci2032_detach(struct comedi_device *dev) 33825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 339dce10abc499ec5e53ea01683fdb2181f24d6776dH Hartley Sweeten if (dev->iobase) 340dce10abc499ec5e53ea01683fdb2181f24d6776dH Hartley Sweeten apci2032_reset(dev); 341aac307f9dd5ce1fe651140a036ab4b0a0571b54aH Hartley Sweeten comedi_pci_detach(dev); 3425c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (dev->read_subdev) 3435c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott kfree(dev->read_subdev->private); 34425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 34525adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 34620a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweetenstatic struct comedi_driver apci2032_driver = { 34720a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .driver_name = "addi_apci_2032", 34820a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .module = THIS_MODULE, 34925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten .auto_attach = apci2032_auto_attach, 35025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten .detach = apci2032_detach, 35120a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten}; 35220a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten 353a690b7e535f2f97a3a05ee570715abeb60a8910fBill Pembertonstatic int apci2032_pci_probe(struct pci_dev *dev, 354b8f4ac237e382accd4b30c75043939f7ed9e79a6H Hartley Sweeten const struct pci_device_id *id) 35520a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten{ 356b8f4ac237e382accd4b30c75043939f7ed9e79a6H Hartley Sweeten return comedi_pci_auto_config(dev, &apci2032_driver, id->driver_data); 35720a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten} 35820a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten 35941e043fcfa2236bb2c4a8335eb09f4c8cee224b3Jingoo Hanstatic const struct pci_device_id apci2032_pci_table[] = { 360317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten { PCI_DEVICE(PCI_VENDOR_ID_ADDIDATA, 0x1004) }, 361317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten { 0 } 362317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten}; 36320a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley SweetenMODULE_DEVICE_TABLE(pci, apci2032_pci_table); 364317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten 36520a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweetenstatic struct pci_driver apci2032_pci_driver = { 36620a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .name = "addi_apci_2032", 36720a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .id_table = apci2032_pci_table, 36820a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .probe = apci2032_pci_probe, 3699901a4d75d007686e8f6473189cafc4b216b7449Peter Huewe .remove = comedi_pci_auto_unconfig, 37020a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten}; 37120a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweetenmodule_comedi_pci_driver(apci2032_driver, apci2032_pci_driver); 37290f703d30dd3e0c16ff80f35e34e511385a05ad5Arun Thomas 37390f703d30dd3e0c16ff80f35e34e511385a05ad5Arun ThomasMODULE_AUTHOR("Comedi http://www.comedi.org"); 374b5ebcaa8d3405e14ca431257fd6c6cdc30df13c5Georg GastMODULE_DESCRIPTION("ADDI-DATA APCI-2032, 32 channel DO boards"); 37590f703d30dd3e0c16ff80f35e34e511385a05ad5Arun ThomasMODULE_LICENSE("GPL"); 376