addi_apci_2032.c revision 56e781203f055e93e2ff510d87a986e2b367c071
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 15005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* step 4: ignored */ 15105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 15205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (err) 15305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 4; 15405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 15505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 0; 156b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten} 157b3b7dab7580982a7d0b55395a8b116808447f85aH Hartley Sweeten 15805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic int apci2032_int_cmd(struct comedi_device *dev, 15905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s) 160d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten{ 16105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_cmd *cmd = &s->async->cmd; 1625c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv = s->private; 1635c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned char enabled_isns; 1645c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned int n; 1655c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned long flags; 166215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott bool do_event; 1675c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 1685c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott enabled_isns = 0; 1695c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott for (n = 0; n < cmd->chanlist_len; n++) 1705c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott enabled_isns |= 1 << CR_CHAN(cmd->chanlist[n]); 17105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 1725c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock_irqsave(&subpriv->spinlock, flags); 173215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott do_event = apci2032_int_start(dev, s, enabled_isns); 1745c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_unlock_irqrestore(&subpriv->spinlock, flags); 17505fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 176215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott if (do_event) 177215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott comedi_event(dev, s); 178215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott 17905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 0; 180d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten} 1817180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten 18205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic int apci2032_int_cancel(struct comedi_device *dev, 18305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s) 184d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten{ 1855c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv = s->private; 1865c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott unsigned long flags; 1875c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 1885c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock_irqsave(&subpriv->spinlock, flags); 1895c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (subpriv->active) 1905c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott apci2032_int_stop(dev, s); 1915c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_unlock_irqrestore(&subpriv->spinlock, flags); 192d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten 19305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return 0; 194d02178b7fb1f2545ebe1004dc8f1f4436a9d37c1H Hartley Sweeten} 195317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten 19605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweetenstatic irqreturn_t apci2032_interrupt(int irq, void *d) 19725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 19805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_device *dev = d; 19905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten struct comedi_subdevice *s = dev->read_subdev; 20056e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten struct comedi_cmd *cmd = &s->async->cmd; 2015c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv; 20205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten unsigned int val; 2035c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott bool do_event = false; 20405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 2050774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott if (!dev->attached) 2060774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott return IRQ_NONE; 2070774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott 20805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Check if VCC OR CC interrupt has occurred */ 20905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten val = inl(dev->iobase + APCI2032_STATUS_REG) & APCI2032_STATUS_IRQ; 21005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (!val) 21105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return IRQ_NONE; 21205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 2135c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott subpriv = s->private; 2145c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock(&subpriv->spinlock); 2155c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 216b652bd83a0528c43e935cb6f2f8df024b7a85c5eIan Abbott val = inl(dev->iobase + APCI2032_INT_STATUS_REG) & 3; 217ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott /* Disable triggered interrupt sources. */ 218ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott outl(~val & 3, dev->iobase + APCI2032_INT_CTRL_REG); 219ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott /* 220ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott * Note: We don't reenable the triggered interrupt sources because they 221ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott * are level-sensitive, hardware error status interrupt sources and 222ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott * they'd keep triggering interrupts repeatedly. 223ef6543dbad12c1086f3bc3565d8266352521d8a3Ian Abbott */ 22405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 2255c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (subpriv->active && (val & subpriv->enabled_isns) != 0) { 22656e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten unsigned short bits = 0; 22756e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten int i; 2285c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 2295c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott /* Bits in scan data correspond to indices in channel list. */ 23056e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten for (i = 0; i < cmd->chanlist_len; i++) { 23156e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten unsigned int chan = CR_CHAN(cmd->chanlist[i]); 23256e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten 23356e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten if (val & (1 << chan)) 23456e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten bits |= (1 << i); 23556e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten } 2365c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 2375c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (comedi_buf_put(s->async, bits)) { 2385c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->async->events |= COMEDI_CB_BLOCK | COMEDI_CB_EOS; 23956e781203f055e93e2ff510d87a986e2b367c071H Hartley Sweeten if (cmd->stop_src == TRIG_COUNT && 240215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott subpriv->stop_count > 0) { 241215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott subpriv->stop_count--; 242215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott if (subpriv->stop_count == 0) { 243215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott /* end of acquisition */ 244215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott s->async->events |= COMEDI_CB_EOA; 245215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott apci2032_int_stop(dev, s); 246215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott } 247215caceb3dac9eb7d431c9da21394c6ccb778b15Ian Abbott } 2485c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott } else { 2495c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott apci2032_int_stop(dev, s); 2505c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->async->events |= COMEDI_CB_OVERFLOW; 2515c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott } 2525c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott do_event = true; 2535c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott } 2545c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 2555c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_unlock(&subpriv->spinlock); 2565c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (do_event) 2575c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott comedi_event(dev, s); 25805fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 25905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten return IRQ_HANDLED; 26025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 26125adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 262791c9792ff2d12a02f0ab1c47fd7f7a94828b05bH Hartley Sweetenstatic int apci2032_reset(struct comedi_device *dev) 26325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 2647180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten outl(0x0, dev->iobase + APCI2032_DO_REG); 2657180eb30deee6c05b8924348a7ac7d4deefcf56eH Hartley Sweeten outl(0x0, dev->iobase + APCI2032_INT_CTRL_REG); 2665b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten 2675b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten addi_watchdog_reset(dev->iobase + APCI2032_WDOG_REG); 26825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 26925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return 0; 27025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 27125adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 27225adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweetenstatic int apci2032_auto_attach(struct comedi_device *dev, 27325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten unsigned long context_unused) 27425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 27525adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten struct pci_dev *pcidev = comedi_to_pci_dev(dev); 27625adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten struct comedi_subdevice *s; 2770c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten int ret; 27825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 279818f569fe930c5b8a05d1a44ece3c63c99c13c88H Hartley Sweeten ret = comedi_pci_enable(dev); 28025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (ret) 28125adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return ret; 28270ff406599a5debfa6e5ef243e5e093f63a9ed69H Hartley Sweeten dev->iobase = pci_resource_start(pcidev, 1); 2830774c2b5c1e0025cb016393d8552171c0ec55c39Ian Abbott apci2032_reset(dev); 28425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 28525adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (pcidev->irq > 0) { 28605fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten ret = request_irq(pcidev->irq, apci2032_interrupt, 28705fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten IRQF_SHARED, dev->board_name, dev); 28825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (ret == 0) 28925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten dev->irq = pcidev->irq; 29025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten } 29125adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 29205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten ret = comedi_alloc_subdevices(dev, 3); 29325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten if (ret) 29425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return ret; 29525adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 2960c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten /* Initialize the digital output subdevice */ 29725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten s = &dev->subdevices[0]; 298cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->type = COMEDI_SUBD_DO; 299cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->subdev_flags = SDF_WRITEABLE; 300cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->n_chan = 32; 301cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->maxdata = 1; 302cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->range_table = &range_digital; 303cf11088242f0f73cb616ab66fb16c2da3d626fffH Hartley Sweeten s->insn_bits = apci2032_do_insn_bits; 30425adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 3050c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten /* Initialize the watchdog subdevice */ 3060c33bdd01abf1d6722792b2022b974116151a572H Hartley Sweeten s = &dev->subdevices[1]; 3075b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten ret = addi_watchdog_init(s, dev->iobase + APCI2032_WDOG_REG); 3085b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten if (ret) 3095b62fe2a03e9d25569c0fa0b81b96ac6f0c9b5fdH Hartley Sweeten return ret; 31025adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 31105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten /* Initialize the interrupt subdevice */ 31205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s = &dev->subdevices[2]; 3135f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->type = COMEDI_SUBD_DI; 3145f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->subdev_flags = SDF_READABLE; 3155f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->n_chan = 2; 3165f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->maxdata = 1; 3175f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->range_table = &range_digital; 3185f6c2a954d17544c68ce83d016ea456207cadeacIan Abbott s->insn_bits = apci2032_int_insn_bits; 31905fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten if (dev->irq) { 3205c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott struct apci2032_int_private *subpriv; 3215c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott 32205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten dev->read_subdev = s; 3235c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott subpriv = kzalloc(sizeof(*subpriv), GFP_KERNEL); 3245c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (!subpriv) 3255c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott return -ENOMEM; 3265c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott spin_lock_init(&subpriv->spinlock); 3275c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->private = subpriv; 328b82fe57c4d059a8ff1190ead1693d66b868353b2Ian Abbott s->subdev_flags = SDF_READABLE | SDF_CMD_READ; 3295c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott s->len_chanlist = 2; 33005fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s->do_cmdtest = apci2032_int_cmdtest; 33105fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s->do_cmd = apci2032_int_cmd; 33205fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten s->cancel = apci2032_int_cancel; 33305fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten } 33405fcdcede016a74ce7350af94aede6a49eebd5c9H Hartley Sweeten 33525adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten return 0; 33625adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 33725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 33825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweetenstatic void apci2032_detach(struct comedi_device *dev) 33925adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten{ 340dce10abc499ec5e53ea01683fdb2181f24d6776dH Hartley Sweeten if (dev->iobase) 341dce10abc499ec5e53ea01683fdb2181f24d6776dH Hartley Sweeten apci2032_reset(dev); 342dce10abc499ec5e53ea01683fdb2181f24d6776dH Hartley Sweeten if (dev->irq) 343dce10abc499ec5e53ea01683fdb2181f24d6776dH Hartley Sweeten free_irq(dev->irq, dev); 3445c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott if (dev->read_subdev) 3455c2d4cba9586ddc3505f51bddf935ddc65a0e0bbIan Abbott kfree(dev->read_subdev->private); 3467f072f54ae5dc9965cbe450419b1389d13e2b849H Hartley Sweeten comedi_pci_disable(dev); 34725adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten} 34825adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten 34920a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweetenstatic struct comedi_driver apci2032_driver = { 35020a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .driver_name = "addi_apci_2032", 35120a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .module = THIS_MODULE, 35225adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten .auto_attach = apci2032_auto_attach, 35325adf2ccf68814fade52f70ed2888b65db1e5156H Hartley Sweeten .detach = apci2032_detach, 35420a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten}; 35520a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten 356a690b7e535f2f97a3a05ee570715abeb60a8910fBill Pembertonstatic int apci2032_pci_probe(struct pci_dev *dev, 357b8f4ac237e382accd4b30c75043939f7ed9e79a6H Hartley Sweeten const struct pci_device_id *id) 35820a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten{ 359b8f4ac237e382accd4b30c75043939f7ed9e79a6H Hartley Sweeten return comedi_pci_auto_config(dev, &apci2032_driver, id->driver_data); 36020a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten} 36120a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten 36241e043fcfa2236bb2c4a8335eb09f4c8cee224b3Jingoo Hanstatic const struct pci_device_id apci2032_pci_table[] = { 363317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten { PCI_DEVICE(PCI_VENDOR_ID_ADDIDATA, 0x1004) }, 364317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten { 0 } 365317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten}; 36620a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley SweetenMODULE_DEVICE_TABLE(pci, apci2032_pci_table); 367317285d71acccbda2fbab7e53d6b33c52a151a32H Hartley Sweeten 36820a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweetenstatic struct pci_driver apci2032_pci_driver = { 36920a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .name = "addi_apci_2032", 37020a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .id_table = apci2032_pci_table, 37120a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten .probe = apci2032_pci_probe, 3729901a4d75d007686e8f6473189cafc4b216b7449Peter Huewe .remove = comedi_pci_auto_unconfig, 37320a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweeten}; 37420a22b706b8ee37d1a2282f2c9bf7f2c73a5a7a5H Hartley Sweetenmodule_comedi_pci_driver(apci2032_driver, apci2032_pci_driver); 37590f703d30dd3e0c16ff80f35e34e511385a05ad5Arun Thomas 37690f703d30dd3e0c16ff80f35e34e511385a05ad5Arun ThomasMODULE_AUTHOR("Comedi http://www.comedi.org"); 377b5ebcaa8d3405e14ca431257fd6c6cdc30df13c5Georg GastMODULE_DESCRIPTION("ADDI-DATA APCI-2032, 32 channel DO boards"); 37890f703d30dd3e0c16ff80f35e34e511385a05ad5Arun ThomasMODULE_LICENSE("GPL"); 379