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