pcmuio.c revision 1fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbf
16baef150380d561a4d695a6be4fc509821c23611Calin Culianu/* 29e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * pcmuio.c 39e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Comedi driver for Winsystems PC-104 based 48/96-channel DIO boards. 49e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 59e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * COMEDI - Linux Control and Measurement Device Interface 69e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Copyright (C) 2006 Calin A. Culianu <calin@ajvar.org> 79e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 89e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * This program is free software; you can redistribute it and/or modify 99e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * it under the terms of the GNU General Public License as published by 109e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * the Free Software Foundation; either version 2 of the License, or 119e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * (at your option) any later version. 129e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 139e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * This program is distributed in the hope that it will be useful, 149e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * but WITHOUT ANY WARRANTY; without even the implied warranty of 159e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 169e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * GNU General Public License for more details. 179e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten */ 186baef150380d561a4d695a6be4fc509821c23611Calin Culianu 196baef150380d561a4d695a6be4fc509821c23611Calin Culianu/* 209e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Driver: pcmuio 219e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Description: Winsystems PC-104 based 48/96-channel DIO boards. 229e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Devices: (Winsystems) PCM-UIO48A [pcmuio48] 239e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * (Winsystems) PCM-UIO96A [pcmuio96] 249e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Author: Calin Culianu <calin@ajvar.org> 259e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Updated: Fri, 13 Jan 2006 12:01:01 -0500 269e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Status: works 279e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 289e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * A driver for the relatively straightforward-to-program PCM-UIO48A and 299e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * PCM-UIO96A boards from Winsystems. These boards use either one or two 309e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * (in the 96-DIO version) WS16C48 ASIC HighDensity I/O Chips (HDIO). This 319e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * chip is interesting in that each I/O line is individually programmable 329e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * for INPUT or OUTPUT (thus comedi_dio_config can be done on a per-channel 339e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * basis). Also, each chip supports edge-triggered interrupts for the first 349e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 24 I/O lines. Of course, since the 96-channel version of the board has 359e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * two ASICs, it can detect polarity changes on up to 48 I/O lines. Since 369e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * this is essentially an (non-PnP) ISA board, I/O Address and IRQ selection 379e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * are done through jumpers on the board. You need to pass that information 389e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * to this driver as the first and second comedi_config option, respectively. 399e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Note that the 48-channel version uses 16 bytes of IO memory and the 96- 409e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * channel version uses 32-bytes (in case you are worried about conflicts). 419e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * The 48-channel board is split into two 24-channel comedi subdevices. The 429e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 96-channel board is split into 4 24-channel DIO subdevices. 439e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 449e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Note that IRQ support has been added, but it is untested. 459e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 469e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * To use edge-detection IRQ support, pass the IRQs of both ASICS (for the 479e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 96 channel version) or just 1 ASIC (for 48-channel version). Then, use 489e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * comedi_commands with TRIG_NOW. Your callback will be called each time an 499e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * edge is triggered, and the data values will be two sample_t's, which 509e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * should be concatenated to form one 32-bit unsigned int. This value is 519e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * the mask of channels that had edges detected from your channel list. Note 529e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * that the bits positions in the mask correspond to positions in your 539e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * chanlist when you specified the command and *not* channel id's! 549e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 559e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * To set the polarity of the edge-detection interrupts pass a nonzero value 569e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * for either CR_RANGE or CR_AREF for edge-up polarity, or a zero value for 579e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * both CR_RANGE and CR_AREF if you want edge-down polarity. 589e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 599e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * In the 48-channel version: 609e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 619e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * On subdev 0, the first 24 channels channels are edge-detect channels. 629e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 639e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * In the 96-channel board you have the following channels that can do edge 649e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * detection: 659e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 669e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * subdev 0, channels 0-24 (first 24 channels of 1st ASIC) 679e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * subdev 2, channels 0-24 (first 24 channels of 2nd ASIC) 689e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * 699e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * Configuration Options: 709e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * [0] - I/O port base address 719e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * [1] - IRQ (for first ASIC, or first 24 channels) 729e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * [2] - IRQ (for second ASIC, pcmuio96 only - IRQ for chans 48-72 739e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten * can be the same as first irq!) 749e1087b5ae4c31c812e3f8a35256d7922a1cdbd6H Hartley Sweeten */ 756baef150380d561a4d695a6be4fc509821c23611Calin Culianu 7625436dc9d84f1be60ff549c9ab712bba2835f284Greg Kroah-Hartman#include <linux/interrupt.h> 775a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 786baef150380d561a4d695a6be4fc509821c23611Calin Culianu 79f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten#include "../comedidev.h" 8033782dd5edf8db3cdb7c81a3523bf743dd0209b7H Hartley Sweeten 81f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten#include "comedi_fc.h" 826baef150380d561a4d695a6be4fc509821c23611Calin Culianu 83f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten/* 84f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * Register I/O map 85f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 86f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * Offset Page 0 Page 1 Page 2 Page 3 87f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * ------ ----------- ----------- ----------- ----------- 88f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x00 Port 0 I/O Port 0 I/O Port 0 I/O Port 0 I/O 89f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x01 Port 1 I/O Port 1 I/O Port 1 I/O Port 1 I/O 90f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x02 Port 2 I/O Port 2 I/O Port 2 I/O Port 2 I/O 91f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x03 Port 3 I/O Port 3 I/O Port 3 I/O Port 3 I/O 92f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x04 Port 4 I/O Port 4 I/O Port 4 I/O Port 4 I/O 93f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x05 Port 5 I/O Port 5 I/O Port 5 I/O Port 5 I/O 94f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x06 INT_PENDING INT_PENDING INT_PENDING INT_PENDING 95f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x07 Page/Lock Page/Lock Page/Lock Page/Lock 96f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x08 N/A POL_0 ENAB_0 INT_ID0 97f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x09 N/A POL_1 ENAB_1 INT_ID1 98f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten * 0x0a N/A POL_2 ENAB_2 INT_ID2 99f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten */ 100f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten#define PCMUIO_PORT_REG(x) (0x00 + (x)) 101f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten#define PCMUIO_INT_PENDING_REG 0x06 102f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten#define PCMUIO_PAGE_LOCK_REG 0x07 103f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten#define PCMUIO_LOCK_PORT(x) ((1 << (x)) & 0x3f) 104f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten#define PCMUIO_PAGE(x) (((x) & 0x3) << 6) 105f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten#define PCMUIO_PAGE_MASK PCMUIO_PAGE(3) 106f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten#define PCMUIO_PAGE_POL 1 107f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten#define PCMUIO_PAGE_ENAB 2 108f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten#define PCMUIO_PAGE_INT_ID 3 109f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten#define PCMUIO_PAGE_REG(x) (0x08 + (x)) 110f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten 111288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define CHANS_PER_PORT 8 112288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define PORTS_PER_ASIC 6 113288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten/* number of channels per comedi subdevice */ 114288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define MAX_CHANS_PER_SUBDEV 24 115288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define PORTS_PER_SUBDEV (MAX_CHANS_PER_SUBDEV / CHANS_PER_PORT) 116288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define CHANS_PER_ASIC (CHANS_PER_PORT * PORTS_PER_ASIC) 117288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define INTR_CHANS_PER_ASIC 24 118288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define INTR_PORTS_PER_SUBDEV (INTR_CHANS_PER_ASIC / CHANS_PER_PORT) 119288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define MAX_DIO_CHANS (PORTS_PER_ASIC * 2 * CHANS_PER_PORT) 120288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define MAX_ASICS (MAX_DIO_CHANS / CHANS_PER_ASIC) 1216baef150380d561a4d695a6be4fc509821c23611Calin Culianu 122288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten/* IO Memory sizes */ 123288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define ASIC_IOSIZE 0x10 124288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define PCMUIO48_IOSIZE ASIC_IOSIZE 125288201328ba804a5630c7a460534e668703f114fH Hartley Sweeten#define PCMUIO96_IOSIZE (ASIC_IOSIZE * 2) 1266baef150380d561a4d695a6be4fc509821c23611Calin Culianu 12770a6001aeffeaa12f2a1c21470e8f3bdfb6ef8e7Bill Pembertonstruct pcmuio_board { 1286baef150380d561a4d695a6be4fc509821c23611Calin Culianu const char *name; 1296baef150380d561a4d695a6be4fc509821c23611Calin Culianu const int num_asics; 13070a6001aeffeaa12f2a1c21470e8f3bdfb6ef8e7Bill Pemberton}; 1316baef150380d561a4d695a6be4fc509821c23611Calin Culianu 132fbe3bb17b9f9e18b771c30449916807c4c25e308H Hartley Sweetenstatic const struct pcmuio_board pcmuio_boards[] = { 133fbe3bb17b9f9e18b771c30449916807c4c25e308H Hartley Sweeten { 134fbe3bb17b9f9e18b771c30449916807c4c25e308H Hartley Sweeten .name = "pcmuio48", 135fbe3bb17b9f9e18b771c30449916807c4c25e308H Hartley Sweeten .num_asics = 1, 136fbe3bb17b9f9e18b771c30449916807c4c25e308H Hartley Sweeten }, { 137fbe3bb17b9f9e18b771c30449916807c4c25e308H Hartley Sweeten .name = "pcmuio96", 138fbe3bb17b9f9e18b771c30449916807c4c25e308H Hartley Sweeten .num_asics = 2, 139fbe3bb17b9f9e18b771c30449916807c4c25e308H Hartley Sweeten }, 140fbe3bb17b9f9e18b771c30449916807c4c25e308H Hartley Sweeten}; 141fbe3bb17b9f9e18b771c30449916807c4c25e308H Hartley Sweeten 142e15849e54405152087cd343437747db8d931fcd7Bill Pembertonstruct pcmuio_subdev_private { 1436baef150380d561a4d695a6be4fc509821c23611Calin Culianu /* The below is only used for intr subdevices */ 1446baef150380d561a4d695a6be4fc509821c23611Calin Culianu struct { 145365c473e1da54e209aa8c01da2084c896f18fb20H Hartley Sweeten /* if non-negative, this subdev has an interrupt asic */ 146365c473e1da54e209aa8c01da2084c896f18fb20H Hartley Sweeten int asic; 147365c473e1da54e209aa8c01da2084c896f18fb20H Hartley Sweeten /* 148365c473e1da54e209aa8c01da2084c896f18fb20H Hartley Sweeten * subdev-relative channel mask for channels 149365c473e1da54e209aa8c01da2084c896f18fb20H Hartley Sweeten * we are interested in 150365c473e1da54e209aa8c01da2084c896f18fb20H Hartley Sweeten */ 151365c473e1da54e209aa8c01da2084c896f18fb20H Hartley Sweeten int enabled_mask; 1526baef150380d561a4d695a6be4fc509821c23611Calin Culianu int active; 1536baef150380d561a4d695a6be4fc509821c23611Calin Culianu int stop_count; 1546baef150380d561a4d695a6be4fc509821c23611Calin Culianu int continuous; 1556baef150380d561a4d695a6be4fc509821c23611Calin Culianu spinlock_t spinlock; 1566baef150380d561a4d695a6be4fc509821c23611Calin Culianu } intr; 157e15849e54405152087cd343437747db8d931fcd7Bill Pemberton}; 1586baef150380d561a4d695a6be4fc509821c23611Calin Culianu 159055f6636d9eb27bc13236e07739e019496c21221Bill Pembertonstruct pcmuio_private { 1606baef150380d561a4d695a6be4fc509821c23611Calin Culianu struct { 1616baef150380d561a4d695a6be4fc509821c23611Calin Culianu unsigned int irq; 1626baef150380d561a4d695a6be4fc509821c23611Calin Culianu spinlock_t spinlock; 1636baef150380d561a4d695a6be4fc509821c23611Calin Culianu } asics[MAX_ASICS]; 164e15849e54405152087cd343437747db8d931fcd7Bill Pemberton struct pcmuio_subdev_private *sprivs; 165055f6636d9eb27bc13236e07739e019496c21221Bill Pemberton}; 1666baef150380d561a4d695a6be4fc509821c23611Calin Culianu 167e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweetenstatic void pcmuio_write(struct comedi_device *dev, unsigned int val, 168e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten int asic, int page, int port) 169e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten{ 170e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten unsigned long iobase = dev->iobase + (asic * ASIC_IOSIZE); 171e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten 172e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten if (page == 0) { 173e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten /* Port registers are valid for any page */ 174e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten outb(val & 0xff, iobase + PCMUIO_PORT_REG(port + 0)); 175e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten outb((val >> 8) & 0xff, iobase + PCMUIO_PORT_REG(port + 1)); 176e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten outb((val >> 16) & 0xff, iobase + PCMUIO_PORT_REG(port + 2)); 177e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten } else { 178e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten outb(PCMUIO_PAGE(page), iobase + PCMUIO_PAGE_LOCK_REG); 179e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten outb(val & 0xff, iobase + PCMUIO_PAGE_REG(0)); 180e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten outb((val >> 8) & 0xff, iobase + PCMUIO_PAGE_REG(1)); 181e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten outb((val >> 16) & 0xff, iobase + PCMUIO_PAGE_REG(2)); 182e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten } 183e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten} 184e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten 18589aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweetenstatic unsigned int pcmuio_read(struct comedi_device *dev, 18689aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten int asic, int page, int port) 18789aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten{ 18889aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten unsigned long iobase = dev->iobase + (asic * ASIC_IOSIZE); 18989aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten unsigned int val; 19089aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten 19189aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten if (page == 0) { 19289aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten /* Port registers are valid for any page */ 19389aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten val = inb(iobase + PCMUIO_PORT_REG(port + 0)); 19489aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten val |= (inb(iobase + PCMUIO_PORT_REG(port + 1)) << 8); 19589aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten val |= (inb(iobase + PCMUIO_PORT_REG(port + 2)) << 16); 19689aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten } else { 19789aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten outb(PCMUIO_PAGE(page), iobase + PCMUIO_PAGE_LOCK_REG); 19889aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten val = inb(iobase + PCMUIO_PAGE_REG(0)); 19989aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten val |= (inb(iobase + PCMUIO_PAGE_REG(1)) << 8); 20089aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten val |= (inb(iobase + PCMUIO_PAGE_REG(2)) << 16); 20189aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten } 20289aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten 20389aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten return val; 20489aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten} 20589aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten 2061fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten/* 2071fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten * Each channel can be individually programmed for input or output. 2081fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten * Writing a '0' to a channel causes the corresponding output pin 2091fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten * to go to a high-z state (pulled high by an external 10K resistor). 2101fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten * This allows it to be used as an input. When used in the input mode, 2111fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten * a read reflects the inverted state of the I/O pin, such that a 2121fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten * high on the pin will read as a '0' in the register. Writing a '1' 2131fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten * to a bit position causes the pin to sink current (up to 12mA), 2141fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten * effectively pulling it low. 2151fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten */ 2160a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukralstatic int pcmuio_dio_insn_bits(struct comedi_device *dev, 2170a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukral struct comedi_subdevice *s, 2180a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukral struct comedi_insn *insn, unsigned int *data) 2196baef150380d561a4d695a6be4fc509821c23611Calin Culianu{ 2201fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten unsigned int mask = data[0] & s->io_bits; /* outputs only */ 2211fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten unsigned int bits = data[1]; 222c4ad65e6ce8a9cfe78d4c4b06b915c17a27ba011H Hartley Sweeten int asic = s->index / 2; 223c4ad65e6ce8a9cfe78d4c4b06b915c17a27ba011H Hartley Sweeten int port = (s->index % 2) ? 3 : 0; 2241fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten unsigned int val; 2256baef150380d561a4d695a6be4fc509821c23611Calin Culianu 2261fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten /* get inverted state of the channels from the port */ 2271fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten val = pcmuio_read(dev, asic, 0, port); 2286baef150380d561a4d695a6be4fc509821c23611Calin Culianu 2291fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten /* get the true state of the channels */ 2301fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten s->state = val ^ ((0x1 << s->n_chan) - 1); 2316baef150380d561a4d695a6be4fc509821c23611Calin Culianu 2321fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten if (mask) { 2331fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten s->state &= ~mask; 2341fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten s->state |= (mask & bits); 2356baef150380d561a4d695a6be4fc509821c23611Calin Culianu 2361fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten /* invert the state and update the channels */ 2371fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten val = s->state ^ ((0x1 << s->n_chan) - 1); 2381fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten pcmuio_write(dev, val, asic, 0, port); 2396baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 2406baef150380d561a4d695a6be4fc509821c23611Calin Culianu 2411fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten data[1] = s->state; 2426baef150380d561a4d695a6be4fc509821c23611Calin Culianu 243a2714e3e42e746d6c8525c35fdcc58fb60c2830dH Hartley Sweeten return insn->n; 2446baef150380d561a4d695a6be4fc509821c23611Calin Culianu} 2456baef150380d561a4d695a6be4fc509821c23611Calin Culianu 2460a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukralstatic int pcmuio_dio_insn_config(struct comedi_device *dev, 2470a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukral struct comedi_subdevice *s, 2480a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukral struct comedi_insn *insn, unsigned int *data) 2496baef150380d561a4d695a6be4fc509821c23611Calin Culianu{ 2501fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten unsigned int chan_mask = 1 << CR_CHAN(insn->chanspec); 251c4ad65e6ce8a9cfe78d4c4b06b915c17a27ba011H Hartley Sweeten int asic = s->index / 2; 252c4ad65e6ce8a9cfe78d4c4b06b915c17a27ba011H Hartley Sweeten int port = (s->index % 2) ? 3 : 0; 2536baef150380d561a4d695a6be4fc509821c23611Calin Culianu 2546baef150380d561a4d695a6be4fc509821c23611Calin Culianu switch (data[0]) { 2556baef150380d561a4d695a6be4fc509821c23611Calin Culianu case INSN_CONFIG_DIO_OUTPUT: 2561fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten s->io_bits |= chan_mask; 2576baef150380d561a4d695a6be4fc509821c23611Calin Culianu break; 2586baef150380d561a4d695a6be4fc509821c23611Calin Culianu case INSN_CONFIG_DIO_INPUT: 2591fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten s->io_bits &= ~chan_mask; 2601fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten pcmuio_write(dev, s->io_bits, asic, 0, port); 2616baef150380d561a4d695a6be4fc509821c23611Calin Culianu break; 2626baef150380d561a4d695a6be4fc509821c23611Calin Culianu case INSN_CONFIG_DIO_QUERY: 2631fdd0fc5fe28cd11ecf64e77892a1d9a1fd89fbfH Hartley Sweeten data[1] = (s->io_bits & chan_mask) ? COMEDI_OUTPUT : COMEDI_INPUT; 2646baef150380d561a4d695a6be4fc509821c23611Calin Culianu break; 2656baef150380d561a4d695a6be4fc509821c23611Calin Culianu default: 2666baef150380d561a4d695a6be4fc509821c23611Calin Culianu return -EINVAL; 2676baef150380d561a4d695a6be4fc509821c23611Calin Culianu break; 2686baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 2696baef150380d561a4d695a6be4fc509821c23611Calin Culianu 2706baef150380d561a4d695a6be4fc509821c23611Calin Culianu return insn->n; 2716baef150380d561a4d695a6be4fc509821c23611Calin Culianu} 2726baef150380d561a4d695a6be4fc509821c23611Calin Culianu 273da91b2692e0939b307f9047192d2b9fe07793e7aBill Pembertonstatic void init_asics(struct comedi_device *dev) 274e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten{ 275a28b59957d3ad01481c2ea87aca50cfdb85417f2H Hartley Sweeten const struct pcmuio_board *board = comedi_board(dev); 2766baef150380d561a4d695a6be4fc509821c23611Calin Culianu int asic; 2776baef150380d561a4d695a6be4fc509821c23611Calin Culianu 278a28b59957d3ad01481c2ea87aca50cfdb85417f2H Hartley Sweeten for (asic = 0; asic < board->num_asics; ++asic) { 2796baef150380d561a4d695a6be4fc509821c23611Calin Culianu /* first, clear all the DIO port bits */ 280e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten pcmuio_write(dev, 0, asic, 0, 0); 281e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten pcmuio_write(dev, 0, asic, 0, 3); 2826baef150380d561a4d695a6be4fc509821c23611Calin Culianu 2836baef150380d561a4d695a6be4fc509821c23611Calin Culianu /* Next, clear all the paged registers for each page */ 284e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten pcmuio_write(dev, 0, asic, PCMUIO_PAGE_POL, 0); 285e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten pcmuio_write(dev, 0, asic, PCMUIO_PAGE_ENAB, 0); 286e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten pcmuio_write(dev, 0, asic, PCMUIO_PAGE_INT_ID, 0); 2876baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 2886baef150380d561a4d695a6be4fc509821c23611Calin Culianu} 2896baef150380d561a4d695a6be4fc509821c23611Calin Culianu 2906b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweetenstatic void pcmuio_stop_intr(struct comedi_device *dev, 2916b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten struct comedi_subdevice *s) 2926b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten{ 2938099a9841f1d9ff15de8f12cf1ba36b574d804c8H Hartley Sweeten struct pcmuio_subdev_private *subpriv = s->private; 294e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten int asic; 2956b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 2966b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten asic = subpriv->intr.asic; 2976b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten if (asic < 0) 2986b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten return; /* not an interrupt subdev */ 2996b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 3006b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten subpriv->intr.enabled_mask = 0; 3016b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten subpriv->intr.active = 0; 302920e2ffbe243fb0555b2c238e26fe7dbc03db98cH Hartley Sweeten s->async->inttrig = NULL; 303e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten 304e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten /* disable all intrs for this subdev.. */ 305e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten pcmuio_write(dev, 0, asic, PCMUIO_PAGE_ENAB, 0); 3066b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten} 3076b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 3083b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweetenstatic void pcmuio_handle_intr_subdev(struct comedi_device *dev, 3093b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten struct comedi_subdevice *s, 3103b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten unsigned triggered) 3113b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten{ 3123b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten struct pcmuio_subdev_private *subpriv = s->private; 3133b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten unsigned int len = s->async->cmd.chanlist_len; 3143b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten unsigned oldevents = s->async->events; 3153b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten unsigned int val = 0; 3163b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten unsigned long flags; 3173b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten unsigned mytrig; 3183b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten unsigned int i; 3193b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3203b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten spin_lock_irqsave(&subpriv->intr.spinlock, flags); 3213b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3223b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (!subpriv->intr.active) 3233b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten goto done; 3243b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 32543d70ce9ac772647baf8aadef1aa0f071bfe7f36H Hartley Sweeten mytrig = triggered; 326dbe9c7929c6c0021414d61f85fe4e2f20f069e1cH Hartley Sweeten mytrig &= ((0x1 << s->n_chan) - 1); 3273b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3283b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (!(mytrig & subpriv->intr.enabled_mask)) 3293b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten goto done; 3303b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3313b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten for (i = 0; i < len; i++) { 3323b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten unsigned int chan = CR_CHAN(s->async->cmd.chanlist[i]); 3333b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (mytrig & (1U << chan)) 3343b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten val |= (1U << i); 3353b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten } 3363b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3373b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten /* Write the scan to the buffer. */ 3383b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (comedi_buf_put(s->async, ((short *)&val)[0]) && 3393b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten comedi_buf_put(s->async, ((short *)&val)[1])) { 3403b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten s->async->events |= (COMEDI_CB_BLOCK | COMEDI_CB_EOS); 3413b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten } else { 3423b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten /* Overflow! Stop acquisition!! */ 3433b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten /* TODO: STOP_ACQUISITION_CALL_HERE!! */ 3443b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten pcmuio_stop_intr(dev, s); 3453b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten } 3463b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3473b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten /* Check for end of acquisition. */ 3483b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (!subpriv->intr.continuous) { 3493b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten /* stop_src == TRIG_COUNT */ 3503b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (subpriv->intr.stop_count > 0) { 3513b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten subpriv->intr.stop_count--; 3523b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (subpriv->intr.stop_count == 0) { 3533b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten s->async->events |= COMEDI_CB_EOA; 3543b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten /* TODO: STOP_ACQUISITION_CALL_HERE!! */ 3553b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten pcmuio_stop_intr(dev, s); 3563b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten } 3573b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten } 3583b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten } 3593b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3603b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweetendone: 3613b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten spin_unlock_irqrestore(&subpriv->intr.spinlock, flags); 3623b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3633b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (oldevents != s->async->events) 3643b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten comedi_event(dev, s); 3653b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten} 3663b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3673b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweetenstatic int pcmuio_handle_asic_interrupt(struct comedi_device *dev, int asic) 3686baef150380d561a4d695a6be4fc509821c23611Calin Culianu{ 3699a1a6cf8ae5ca58171e117335b9983e3cfa2185cH Hartley Sweeten struct pcmuio_private *devpriv = dev->private; 3708099a9841f1d9ff15de8f12cf1ba36b574d804c8H Hartley Sweeten struct pcmuio_subdev_private *subpriv; 371021314f82405594344b857e13e0493e11dad7298H Hartley Sweeten unsigned long iobase = dev->iobase + (asic * ASIC_IOSIZE); 37289aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten unsigned int triggered = 0; 3733b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten int got1 = 0; 3743b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten unsigned long flags; 3753b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten unsigned char int_pend; 37668720ae68a94444387d56bc5a166396e33e420a5H Hartley Sweeten int i; 3776baef150380d561a4d695a6be4fc509821c23611Calin Culianu 3783b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten spin_lock_irqsave(&devpriv->asics[asic].spinlock, flags); 3793b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 380f45a1f26eae4cadbfeb65b4b36bfa3583f694066H Hartley Sweeten int_pend = inb(iobase + PCMUIO_INT_PENDING_REG) & 0x07; 3813b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (int_pend) { 38289aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten triggered = pcmuio_read(dev, asic, PCMUIO_PAGE_INT_ID, 0); 38389aaa92adffa5c57d9c2a545c7cb9809ddd3b615H Hartley Sweeten pcmuio_write(dev, 0, asic, PCMUIO_PAGE_INT_ID, 0); 3846baef150380d561a4d695a6be4fc509821c23611Calin Culianu 3853b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten ++got1; 3863b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten } 3873b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3883b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten spin_unlock_irqrestore(&devpriv->asics[asic].spinlock, flags); 3893b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 3903b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (triggered) { 3913b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten struct comedi_subdevice *s; 3923b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten /* TODO here: dispatch io lines to subdevs with commands.. */ 3933b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten for (i = 0; i < dev->n_subdevices; i++) { 3943b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten s = &dev->subdevices[i]; 3953b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten subpriv = s->private; 3963b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (subpriv->intr.asic == asic) { 3973b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten /* 3983b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten * This is an interrupt subdev, and it 3993b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten * matches this asic! 4003b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten */ 4013b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten pcmuio_handle_intr_subdev(dev, s, 4023b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten triggered); 4036baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 4043b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten } 4053b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten } 4063b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten return got1; 4073b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten} 4083b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten 4093b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweetenstatic irqreturn_t interrupt_pcmuio(int irq, void *d) 4103b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten{ 4113b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten struct comedi_device *dev = d; 4123b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten struct pcmuio_private *devpriv = dev->private; 4133b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten int got1 = 0; 4143b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten int asic; 4156baef150380d561a4d695a6be4fc509821c23611Calin Culianu 4163b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten for (asic = 0; asic < MAX_ASICS; ++asic) { 4173b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (irq == devpriv->asics[asic].irq) { 4183b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten /* it is an interrupt for ASIC #asic */ 4193b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten if (pcmuio_handle_asic_interrupt(dev, asic)) 4203b48c535802eb515069b4f2ff26f0601eabf51b8H Hartley Sweeten got1++; 4216baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 4226baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 4236baef150380d561a4d695a6be4fc509821c23611Calin Culianu if (!got1) 4246baef150380d561a4d695a6be4fc509821c23611Calin Culianu return IRQ_NONE; /* interrupt from other source */ 4256baef150380d561a4d695a6be4fc509821c23611Calin Culianu return IRQ_HANDLED; 4266baef150380d561a4d695a6be4fc509821c23611Calin Culianu} 4276baef150380d561a4d695a6be4fc509821c23611Calin Culianu 4280a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukralstatic int pcmuio_start_intr(struct comedi_device *dev, 4290a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukral struct comedi_subdevice *s) 4306baef150380d561a4d695a6be4fc509821c23611Calin Culianu{ 4318099a9841f1d9ff15de8f12cf1ba36b574d804c8H Hartley Sweeten struct pcmuio_subdev_private *subpriv = s->private; 4329a1a6cf8ae5ca58171e117335b9983e3cfa2185cH Hartley Sweeten 4336baef150380d561a4d695a6be4fc509821c23611Calin Culianu if (!subpriv->intr.continuous && subpriv->intr.stop_count == 0) { 4346baef150380d561a4d695a6be4fc509821c23611Calin Culianu /* An empty acquisition! */ 4356baef150380d561a4d695a6be4fc509821c23611Calin Culianu s->async->events |= COMEDI_CB_EOA; 4366baef150380d561a4d695a6be4fc509821c23611Calin Culianu subpriv->intr.active = 0; 4376baef150380d561a4d695a6be4fc509821c23611Calin Culianu return 1; 4386baef150380d561a4d695a6be4fc509821c23611Calin Culianu } else { 4396baef150380d561a4d695a6be4fc509821c23611Calin Culianu unsigned bits = 0, pol_bits = 0, n; 440e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten int asic; 441ea6d0d4cab4f4f2d6a88f3bce4707fe92696fd3fBill Pemberton struct comedi_cmd *cmd = &s->async->cmd; 4426baef150380d561a4d695a6be4fc509821c23611Calin Culianu 443c3744138715045adb316284ee7a1e608f0278f6cBill Pemberton asic = subpriv->intr.asic; 444c3744138715045adb316284ee7a1e608f0278f6cBill Pemberton if (asic < 0) 4456baef150380d561a4d695a6be4fc509821c23611Calin Culianu return 1; /* not an interrupt 4466baef150380d561a4d695a6be4fc509821c23611Calin Culianu subdev */ 4476baef150380d561a4d695a6be4fc509821c23611Calin Culianu subpriv->intr.enabled_mask = 0; 4486baef150380d561a4d695a6be4fc509821c23611Calin Culianu subpriv->intr.active = 1; 4496baef150380d561a4d695a6be4fc509821c23611Calin Culianu if (cmd->chanlist) { 4506baef150380d561a4d695a6be4fc509821c23611Calin Culianu for (n = 0; n < cmd->chanlist_len; n++) { 4516baef150380d561a4d695a6be4fc509821c23611Calin Culianu bits |= (1U << CR_CHAN(cmd->chanlist[n])); 4526baef150380d561a4d695a6be4fc509821c23611Calin Culianu pol_bits |= (CR_AREF(cmd->chanlist[n]) 4530a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukral || CR_RANGE(cmd-> 4540a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukral chanlist[n]) ? 1U : 0U) 4550a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukral << CR_CHAN(cmd->chanlist[n]); 4566baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 4576baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 458dbe9c7929c6c0021414d61f85fe4e2f20f069e1cH Hartley Sweeten bits &= ((0x1 << s->n_chan) - 1); 4596baef150380d561a4d695a6be4fc509821c23611Calin Culianu subpriv->intr.enabled_mask = bits; 4606baef150380d561a4d695a6be4fc509821c23611Calin Culianu 461e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten /* set pol and enab intrs for this subdev.. */ 462e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten pcmuio_write(dev, pol_bits, asic, PCMUIO_PAGE_POL, 0); 463e4eae7c031e3eceed6dbc6358c15d55604fb31cdH Hartley Sweeten pcmuio_write(dev, bits, asic, PCMUIO_PAGE_ENAB, 0); 4646baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 4656baef150380d561a4d695a6be4fc509821c23611Calin Culianu return 0; 4666baef150380d561a4d695a6be4fc509821c23611Calin Culianu} 4676baef150380d561a4d695a6be4fc509821c23611Calin Culianu 468da91b2692e0939b307f9047192d2b9fe07793e7aBill Pembertonstatic int pcmuio_cancel(struct comedi_device *dev, struct comedi_subdevice *s) 4696baef150380d561a4d695a6be4fc509821c23611Calin Culianu{ 4708099a9841f1d9ff15de8f12cf1ba36b574d804c8H Hartley Sweeten struct pcmuio_subdev_private *subpriv = s->private; 4716baef150380d561a4d695a6be4fc509821c23611Calin Culianu unsigned long flags; 4726baef150380d561a4d695a6be4fc509821c23611Calin Culianu 4735f74ea14c07fee91d3bdbaad88bff6264c6200e6Greg Kroah-Hartman spin_lock_irqsave(&subpriv->intr.spinlock, flags); 4746baef150380d561a4d695a6be4fc509821c23611Calin Culianu if (subpriv->intr.active) 4756baef150380d561a4d695a6be4fc509821c23611Calin Culianu pcmuio_stop_intr(dev, s); 4765f74ea14c07fee91d3bdbaad88bff6264c6200e6Greg Kroah-Hartman spin_unlock_irqrestore(&subpriv->intr.spinlock, flags); 4776baef150380d561a4d695a6be4fc509821c23611Calin Culianu 4786baef150380d561a4d695a6be4fc509821c23611Calin Culianu return 0; 4796baef150380d561a4d695a6be4fc509821c23611Calin Culianu} 4806baef150380d561a4d695a6be4fc509821c23611Calin Culianu 4816baef150380d561a4d695a6be4fc509821c23611Calin Culianu/* 4826baef150380d561a4d695a6be4fc509821c23611Calin Culianu * Internal trigger function to start acquisition for an 'INTERRUPT' subdevice. 4836baef150380d561a4d695a6be4fc509821c23611Calin Culianu */ 4846baef150380d561a4d695a6be4fc509821c23611Calin Culianustatic int 485da91b2692e0939b307f9047192d2b9fe07793e7aBill Pembertonpcmuio_inttrig_start_intr(struct comedi_device *dev, struct comedi_subdevice *s, 4860a85b6f0ab0d2edb0d41b32697111ce0e4f43496Mithlesh Thukral unsigned int trignum) 4876baef150380d561a4d695a6be4fc509821c23611Calin Culianu{ 4888099a9841f1d9ff15de8f12cf1ba36b574d804c8H Hartley Sweeten struct pcmuio_subdev_private *subpriv = s->private; 4896baef150380d561a4d695a6be4fc509821c23611Calin Culianu unsigned long flags; 4906baef150380d561a4d695a6be4fc509821c23611Calin Culianu int event = 0; 4916baef150380d561a4d695a6be4fc509821c23611Calin Culianu 4926baef150380d561a4d695a6be4fc509821c23611Calin Culianu if (trignum != 0) 4936baef150380d561a4d695a6be4fc509821c23611Calin Culianu return -EINVAL; 4946baef150380d561a4d695a6be4fc509821c23611Calin Culianu 4955f74ea14c07fee91d3bdbaad88bff6264c6200e6Greg Kroah-Hartman spin_lock_irqsave(&subpriv->intr.spinlock, flags); 496920e2ffbe243fb0555b2c238e26fe7dbc03db98cH Hartley Sweeten s->async->inttrig = NULL; 4970389245f0c5692111c0dc8d997fc4af72d789472Ravishankar karkala Mallikarjunayya if (subpriv->intr.active) 4986baef150380d561a4d695a6be4fc509821c23611Calin Culianu event = pcmuio_start_intr(dev, s); 4990389245f0c5692111c0dc8d997fc4af72d789472Ravishankar karkala Mallikarjunayya 5005f74ea14c07fee91d3bdbaad88bff6264c6200e6Greg Kroah-Hartman spin_unlock_irqrestore(&subpriv->intr.spinlock, flags); 5016baef150380d561a4d695a6be4fc509821c23611Calin Culianu 5020389245f0c5692111c0dc8d997fc4af72d789472Ravishankar karkala Mallikarjunayya if (event) 5036baef150380d561a4d695a6be4fc509821c23611Calin Culianu comedi_event(dev, s); 5046baef150380d561a4d695a6be4fc509821c23611Calin Culianu 5056baef150380d561a4d695a6be4fc509821c23611Calin Culianu return 1; 5066baef150380d561a4d695a6be4fc509821c23611Calin Culianu} 5076baef150380d561a4d695a6be4fc509821c23611Calin Culianu 5086baef150380d561a4d695a6be4fc509821c23611Calin Culianu/* 5096baef150380d561a4d695a6be4fc509821c23611Calin Culianu * 'do_cmd' function for an 'INTERRUPT' subdevice. 5106baef150380d561a4d695a6be4fc509821c23611Calin Culianu */ 511da91b2692e0939b307f9047192d2b9fe07793e7aBill Pembertonstatic int pcmuio_cmd(struct comedi_device *dev, struct comedi_subdevice *s) 5126baef150380d561a4d695a6be4fc509821c23611Calin Culianu{ 5138099a9841f1d9ff15de8f12cf1ba36b574d804c8H Hartley Sweeten struct pcmuio_subdev_private *subpriv = s->private; 514ea6d0d4cab4f4f2d6a88f3bce4707fe92696fd3fBill Pemberton struct comedi_cmd *cmd = &s->async->cmd; 5156baef150380d561a4d695a6be4fc509821c23611Calin Culianu unsigned long flags; 5166baef150380d561a4d695a6be4fc509821c23611Calin Culianu int event = 0; 5176baef150380d561a4d695a6be4fc509821c23611Calin Culianu 5185f74ea14c07fee91d3bdbaad88bff6264c6200e6Greg Kroah-Hartman spin_lock_irqsave(&subpriv->intr.spinlock, flags); 5196baef150380d561a4d695a6be4fc509821c23611Calin Culianu subpriv->intr.active = 1; 5206baef150380d561a4d695a6be4fc509821c23611Calin Culianu 5216baef150380d561a4d695a6be4fc509821c23611Calin Culianu /* Set up end of acquisition. */ 5226baef150380d561a4d695a6be4fc509821c23611Calin Culianu switch (cmd->stop_src) { 5236baef150380d561a4d695a6be4fc509821c23611Calin Culianu case TRIG_COUNT: 5246baef150380d561a4d695a6be4fc509821c23611Calin Culianu subpriv->intr.continuous = 0; 5256baef150380d561a4d695a6be4fc509821c23611Calin Culianu subpriv->intr.stop_count = cmd->stop_arg; 5266baef150380d561a4d695a6be4fc509821c23611Calin Culianu break; 5276baef150380d561a4d695a6be4fc509821c23611Calin Culianu default: 5286baef150380d561a4d695a6be4fc509821c23611Calin Culianu /* TRIG_NONE */ 5296baef150380d561a4d695a6be4fc509821c23611Calin Culianu subpriv->intr.continuous = 1; 5306baef150380d561a4d695a6be4fc509821c23611Calin Culianu subpriv->intr.stop_count = 0; 5316baef150380d561a4d695a6be4fc509821c23611Calin Culianu break; 5326baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 5336baef150380d561a4d695a6be4fc509821c23611Calin Culianu 5346baef150380d561a4d695a6be4fc509821c23611Calin Culianu /* Set up start of acquisition. */ 5356baef150380d561a4d695a6be4fc509821c23611Calin Culianu switch (cmd->start_src) { 5366baef150380d561a4d695a6be4fc509821c23611Calin Culianu case TRIG_INT: 5376baef150380d561a4d695a6be4fc509821c23611Calin Culianu s->async->inttrig = pcmuio_inttrig_start_intr; 5386baef150380d561a4d695a6be4fc509821c23611Calin Culianu break; 5396baef150380d561a4d695a6be4fc509821c23611Calin Culianu default: 5406baef150380d561a4d695a6be4fc509821c23611Calin Culianu /* TRIG_NOW */ 5416baef150380d561a4d695a6be4fc509821c23611Calin Culianu event = pcmuio_start_intr(dev, s); 5426baef150380d561a4d695a6be4fc509821c23611Calin Culianu break; 5436baef150380d561a4d695a6be4fc509821c23611Calin Culianu } 5445f74ea14c07fee91d3bdbaad88bff6264c6200e6Greg Kroah-Hartman spin_unlock_irqrestore(&subpriv->intr.spinlock, flags); 5456baef150380d561a4d695a6be4fc509821c23611Calin Culianu 5460389245f0c5692111c0dc8d997fc4af72d789472Ravishankar karkala Mallikarjunayya if (event) 5476baef150380d561a4d695a6be4fc509821c23611Calin Culianu comedi_event(dev, s); 5486baef150380d561a4d695a6be4fc509821c23611Calin Culianu 5496baef150380d561a4d695a6be4fc509821c23611Calin Culianu return 0; 5506baef150380d561a4d695a6be4fc509821c23611Calin Culianu} 5516baef150380d561a4d695a6be4fc509821c23611Calin Culianu 552f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweetenstatic int pcmuio_cmdtest(struct comedi_device *dev, 553f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten struct comedi_subdevice *s, 554f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten struct comedi_cmd *cmd) 5556baef150380d561a4d695a6be4fc509821c23611Calin Culianu{ 556f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten int err = 0; 557f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 558f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten /* Step 1 : check if triggers are trivially valid */ 559f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 560f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_src(&cmd->start_src, TRIG_NOW | TRIG_INT); 561f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_src(&cmd->scan_begin_src, TRIG_EXT); 562f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_src(&cmd->convert_src, TRIG_NOW); 563f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT); 564f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_src(&cmd->stop_src, TRIG_COUNT | TRIG_NONE); 565f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 566f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten if (err) 567f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten return 1; 568f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 569f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten /* Step 2a : make sure trigger sources are unique */ 570f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 571f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_is_unique(cmd->start_src); 572f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_is_unique(cmd->stop_src); 573f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 574f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten /* Step 2b : and mutually compatible */ 575f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 576f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten if (err) 577f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten return 2; 578f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 579f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten /* Step 3: check if arguments are trivially valid */ 580f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 581f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_arg_is(&cmd->start_arg, 0); 582f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_arg_is(&cmd->scan_begin_arg, 0); 583f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_arg_is(&cmd->convert_arg, 0); 584f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_arg_is(&cmd->scan_end_arg, cmd->chanlist_len); 585f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 586f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten switch (cmd->stop_src) { 587f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten case TRIG_COUNT: 588f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten /* any count allowed */ 589f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten break; 590f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten case TRIG_NONE: 591f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten err |= cfc_check_trigger_arg_is(&cmd->stop_arg, 0); 592f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten break; 593f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten default: 594f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten break; 595f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten } 596f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 597f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten if (err) 598f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten return 3; 599f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 600f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten /* step 4: fix up any arguments */ 601f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 602f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten /* if (err) return 4; */ 603f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten 604f95d45d114e1fd024bdee67beb80fce9b9c96126H Hartley Sweeten return 0; 6056baef150380d561a4d695a6be4fc509821c23611Calin Culianu} 6066baef150380d561a4d695a6be4fc509821c23611Calin Culianu 6076b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweetenstatic int pcmuio_attach(struct comedi_device *dev, struct comedi_devconfig *it) 6086b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten{ 609a28b59957d3ad01481c2ea87aca50cfdb85417f2H Hartley Sweeten const struct pcmuio_board *board = comedi_board(dev); 6106b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten struct comedi_subdevice *s; 6118099a9841f1d9ff15de8f12cf1ba36b574d804c8H Hartley Sweeten struct pcmuio_private *devpriv; 6128099a9841f1d9ff15de8f12cf1ba36b574d804c8H Hartley Sweeten struct pcmuio_subdev_private *subpriv; 6131699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten int sdev_no, n_subdevs, asic; 6146b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten unsigned int irq[MAX_ASICS]; 6158b6c56949ffa83dbc2a6e8fa3f98b10a19372207H Hartley Sweeten int ret; 6166b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 6176b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten irq[0] = it->options[1]; 6186b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten irq[1] = it->options[2]; 6196b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 62035626c2efecd6dad6ef67124ae2604385b717ed7H Hartley Sweeten ret = comedi_request_region(dev, it->options[0], 62135626c2efecd6dad6ef67124ae2604385b717ed7H Hartley Sweeten board->num_asics * ASIC_IOSIZE); 62235626c2efecd6dad6ef67124ae2604385b717ed7H Hartley Sweeten if (ret) 62335626c2efecd6dad6ef67124ae2604385b717ed7H Hartley Sweeten return ret; 6246b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 625c34fa261b0ac3a862ccd3f71ee55a16b920dfc83H Hartley Sweeten devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL); 626c34fa261b0ac3a862ccd3f71ee55a16b920dfc83H Hartley Sweeten if (!devpriv) 627c34fa261b0ac3a862ccd3f71ee55a16b920dfc83H Hartley Sweeten return -ENOMEM; 628c34fa261b0ac3a862ccd3f71ee55a16b920dfc83H Hartley Sweeten dev->private = devpriv; 6296b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 630021314f82405594344b857e13e0493e11dad7298H Hartley Sweeten for (asic = 0; asic < MAX_ASICS; ++asic) 6316b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten spin_lock_init(&devpriv->asics[asic].spinlock); 6326b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 633c87e1f26054388b661298a61e906a03fa2cd193eH Hartley Sweeten n_subdevs = board->num_asics * 2; 63478110bb8dc4a7ff331bfa3cfe7d4e287cfb3f22bJoe Perches devpriv->sprivs = kcalloc(n_subdevs, 63578110bb8dc4a7ff331bfa3cfe7d4e287cfb3f22bJoe Perches sizeof(struct pcmuio_subdev_private), 63678110bb8dc4a7ff331bfa3cfe7d4e287cfb3f22bJoe Perches GFP_KERNEL); 63778110bb8dc4a7ff331bfa3cfe7d4e287cfb3f22bJoe Perches if (!devpriv->sprivs) 6386b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten return -ENOMEM; 639eea6838b1206b0ac90110f1a6f58e101aa496e99H Hartley Sweeten 6408b6c56949ffa83dbc2a6e8fa3f98b10a19372207H Hartley Sweeten ret = comedi_alloc_subdevices(dev, n_subdevs); 6418b6c56949ffa83dbc2a6e8fa3f98b10a19372207H Hartley Sweeten if (ret) 6428b6c56949ffa83dbc2a6e8fa3f98b10a19372207H Hartley Sweeten return ret; 6436b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 6446b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten for (sdev_no = 0; sdev_no < (int)dev->n_subdevices; ++sdev_no) { 64568720ae68a94444387d56bc5a166396e33e420a5H Hartley Sweeten s = &dev->subdevices[sdev_no]; 6468099a9841f1d9ff15de8f12cf1ba36b574d804c8H Hartley Sweeten subpriv = &devpriv->sprivs[sdev_no]; 6478099a9841f1d9ff15de8f12cf1ba36b574d804c8H Hartley Sweeten s->private = subpriv; 6486b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten s->maxdata = 1; 6496b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten s->range_table = &range_digital; 6506b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten s->subdev_flags = SDF_READABLE | SDF_WRITABLE; 6516b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten s->type = COMEDI_SUBD_DIO; 6526b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten s->insn_bits = pcmuio_dio_insn_bits; 6536b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten s->insn_config = pcmuio_dio_insn_config; 654c87e1f26054388b661298a61e906a03fa2cd193eH Hartley Sweeten s->n_chan = 24; 6556b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 6561699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten /* subdevices 0 and 2 suppport interrupts */ 6571699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten if ((sdev_no % 2) == 0) { 6581699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten /* setup the interrupt subdevice */ 6591699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten subpriv->intr.asic = sdev_no / 2; 6601699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten dev->read_subdev = s; 6611699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten s->subdev_flags |= SDF_CMD_READ; 6621699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten s->cancel = pcmuio_cancel; 6631699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten s->do_cmd = pcmuio_cmd; 6641699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten s->do_cmdtest = pcmuio_cmdtest; 6651699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten s->len_chanlist = s->n_chan; 6661699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten } else { 6671699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten subpriv->intr.asic = -1; 6681699d80aef8ba7992d5f4176aed3504db8cffaf9H Hartley Sweeten s->len_chanlist = 1; 6696b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten } 6706b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten spin_lock_init(&subpriv->intr.spinlock); 6716b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten } 6726b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 6736b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten init_asics(dev); /* clear out all the registers, basically */ 6746b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 6756b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten for (asic = 0; irq[0] && asic < MAX_ASICS; ++asic) { 6766b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten if (irq[asic] 6776b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten && request_irq(irq[asic], interrupt_pcmuio, 678a28b59957d3ad01481c2ea87aca50cfdb85417f2H Hartley Sweeten IRQF_SHARED, board->name, dev)) { 6796b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten int i; 6806b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten /* unroll the allocated irqs.. */ 6816b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten for (i = asic - 1; i >= 0; --i) { 6826b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten free_irq(irq[i], dev); 6836b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten devpriv->asics[i].irq = irq[i] = 0; 6846b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten } 6856b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten irq[asic] = 0; 6866b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten } 6876b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten devpriv->asics[asic].irq = irq[asic]; 6886b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten } 6896b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 6906b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten if (irq[0]) { 691f41ad6675f2d5705a0fc1e210af8eb4a27dbacb4Ian Abbott dev_dbg(dev->class_dev, "irq: %u\n", irq[0]); 692a28b59957d3ad01481c2ea87aca50cfdb85417f2H Hartley Sweeten if (irq[1] && board->num_asics == 2) 693f41ad6675f2d5705a0fc1e210af8eb4a27dbacb4Ian Abbott dev_dbg(dev->class_dev, "second ASIC irq: %u\n", 694f41ad6675f2d5705a0fc1e210af8eb4a27dbacb4Ian Abbott irq[1]); 6956b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten } else { 696f41ad6675f2d5705a0fc1e210af8eb4a27dbacb4Ian Abbott dev_dbg(dev->class_dev, "(IRQ mode disabled)\n"); 6976b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten } 6986b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 6996b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 7006b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten return 1; 7016b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten} 7026b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 703484ecc95d9cdfa8b2f7029e2f3409cf078aed4abH Hartley Sweetenstatic void pcmuio_detach(struct comedi_device *dev) 7046b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten{ 7059a1a6cf8ae5ca58171e117335b9983e3cfa2185cH Hartley Sweeten struct pcmuio_private *devpriv = dev->private; 7066b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten int i; 7076b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 7086b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten for (i = 0; i < MAX_ASICS; ++i) { 7096b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten if (devpriv->asics[i].irq) 7106b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten free_irq(devpriv->asics[i].irq, dev); 7116b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten } 7126b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten if (devpriv && devpriv->sprivs) 7136b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten kfree(devpriv->sprivs); 714a32c6d0084992d3e58a93120c9ce9527e80c651eH Hartley Sweeten comedi_legacy_detach(dev); 7156b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten} 7166b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten 717294f930d98be86fb4f34302c718a49719650857fH Hartley Sweetenstatic struct comedi_driver pcmuio_driver = { 7186b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten .driver_name = "pcmuio", 7196b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten .module = THIS_MODULE, 7206b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten .attach = pcmuio_attach, 7216b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten .detach = pcmuio_detach, 7226b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten .board_name = &pcmuio_boards[0].name, 7236b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten .offset = sizeof(struct pcmuio_board), 7246b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten .num_names = ARRAY_SIZE(pcmuio_boards), 7256b19f9c6bee7afcd1e5dee9528333b2aa52de404H Hartley Sweeten}; 726294f930d98be86fb4f34302c718a49719650857fH Hartley Sweetenmodule_comedi_driver(pcmuio_driver); 72790f703d30dd3e0c16ff80f35e34e511385a05ad5Arun Thomas 72890f703d30dd3e0c16ff80f35e34e511385a05ad5Arun ThomasMODULE_AUTHOR("Comedi http://www.comedi.org"); 72990f703d30dd3e0c16ff80f35e34e511385a05ad5Arun ThomasMODULE_DESCRIPTION("Comedi low-level driver"); 73090f703d30dd3e0c16ff80f35e34e511385a05ad5Arun ThomasMODULE_LICENSE("GPL"); 731