Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / staging / comedi / drivers / rtd520.c
1 /*
2  * comedi/drivers/rtd520.c
3  * Comedi driver for Real Time Devices (RTD) PCI4520/DM7520
4  *
5  * COMEDI - Linux Control and Measurement Device Interface
6  * Copyright (C) 2001 David A. Schleef <ds@schleef.org>
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License as published by
10  * the Free Software Foundation; either version 2 of the License, or
11  * (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16  * GNU General Public License for more details.
17  */
18
19 /*
20  * Driver: rtd520
21  * Description: Real Time Devices PCI4520/DM7520
22  * Devices: [Real Time Devices] DM7520HR-1 (DM7520), DM7520HR-8,
23  *   PCI4520 (PCI4520), PCI4520-8
24  * Author: Dan Christian
25  * Status: Works. Only tested on DM7520-8. Not SMP safe.
26  *
27  * Configuration options: not applicable, uses PCI auto config
28  */
29
30 /*
31  * Created by Dan Christian, NASA Ames Research Center.
32  *
33  * The PCI4520 is a PCI card. The DM7520 is a PC/104-plus card.
34  * Both have:
35  *   8/16 12 bit ADC with FIFO and channel gain table
36  *   8 bits high speed digital out (for external MUX) (or 8 in or 8 out)
37  *   8 bits high speed digital in with FIFO and interrupt on change (or 8 IO)
38  *   2 12 bit DACs with FIFOs
39  *   2 bits output
40  *   2 bits input
41  *   bus mastering DMA
42  *   timers: ADC sample, pacer, burst, about, delay, DA1, DA2
43  *   sample counter
44  *   3 user timer/counters (8254)
45  *   external interrupt
46  *
47  * The DM7520 has slightly fewer features (fewer gain steps).
48  *
49  * These boards can support external multiplexors and multi-board
50  * synchronization, but this driver doesn't support that.
51  *
52  * Board docs: http://www.rtdusa.com/PC104/DM/analog%20IO/dm7520.htm
53  * Data sheet: http://www.rtdusa.com/pdf/dm7520.pdf
54  * Example source: http://www.rtdusa.com/examples/dm/dm7520.zip
55  * Call them and ask for the register level manual.
56  * PCI chip: http://www.plxtech.com/products/io/pci9080
57  *
58  * Notes:
59  * This board is memory mapped. There is some IO stuff, but it isn't needed.
60  *
61  * I use a pretty loose naming style within the driver (rtd_blah).
62  * All externally visible names should be rtd520_blah.
63  * I use camelCase for structures (and inside them).
64  * I may also use upper CamelCase for function names (old habit).
65  *
66  * This board is somewhat related to the RTD PCI4400 board.
67  *
68  * I borrowed heavily from the ni_mio_common, ni_atmio16d, mite, and
69  * das1800, since they have the best documented code. Driver cb_pcidas64.c
70  * uses the same DMA controller.
71  *
72  * As far as I can tell, the About interrupt doesn't work if Sample is
73  * also enabled. It turns out that About really isn't needed, since
74  * we always count down samples read.
75  *
76  * There was some timer/counter code, but it didn't follow the right API.
77  */
78
79 /*
80  * driver status:
81  *
82  * Analog-In supports instruction and command mode.
83  *
84  * With DMA, you can sample at 1.15Mhz with 70% idle on a 400Mhz K6-2
85  * (single channel, 64K read buffer). I get random system lockups when
86  * using DMA with ALI-15xx based systems. I haven't been able to test
87  * any other chipsets. The lockups happen soon after the start of an
88  * acquistion, not in the middle of a long run.
89  *
90  * Without DMA, you can do 620Khz sampling with 20% idle on a 400Mhz K6-2
91  * (with a 256K read buffer).
92  *
93  * Digital-IO and Analog-Out only support instruction mode.
94  */
95
96 #include <linux/module.h>
97 #include <linux/delay.h>
98 #include <linux/interrupt.h>
99
100 #include "../comedi_pci.h"
101
102 #include "plx9080.h"
103
104 /*
105  * Local Address Space 0 Offsets
106  */
107 #define LAS0_USER_IO            0x0008  /* User I/O */
108 #define LAS0_ADC                0x0010  /* FIFO Status/Software A/D Start */
109 #define FS_DAC1_NOT_EMPTY       (1 << 0)        /* DAC1 FIFO not empty */
110 #define FS_DAC1_HEMPTY          (1 << 1)        /* DAC1 FIFO half empty */
111 #define FS_DAC1_NOT_FULL        (1 << 2)        /* DAC1 FIFO not full */
112 #define FS_DAC2_NOT_EMPTY       (1 << 4)        /* DAC2 FIFO not empty */
113 #define FS_DAC2_HEMPTY          (1 << 5)        /* DAC2 FIFO half empty */
114 #define FS_DAC2_NOT_FULL        (1 << 6)        /* DAC2 FIFO not full */
115 #define FS_ADC_NOT_EMPTY        (1 << 8)        /* ADC FIFO not empty */
116 #define FS_ADC_HEMPTY           (1 << 9)        /* ADC FIFO half empty */
117 #define FS_ADC_NOT_FULL         (1 << 10)       /* ADC FIFO not full */
118 #define FS_DIN_NOT_EMPTY        (1 << 12)       /* DIN FIFO not empty */
119 #define FS_DIN_HEMPTY           (1 << 13)       /* DIN FIFO half empty */
120 #define FS_DIN_NOT_FULL         (1 << 14)       /* DIN FIFO not full */
121 #define LAS0_DAC1               0x0014  /* Software D/A1 Update (w) */
122 #define LAS0_DAC2               0x0018  /* Software D/A2 Update (w) */
123 #define LAS0_DAC                0x0024  /* Software Simultaneous Update (w) */
124 #define LAS0_PACER              0x0028  /* Software Pacer Start/Stop */
125 #define LAS0_TIMER              0x002c  /* Timer Status/HDIN Software Trig. */
126 #define LAS0_IT                 0x0030  /* Interrupt Status/Enable */
127 #define IRQM_ADC_FIFO_WRITE     (1 << 0)        /* ADC FIFO Write */
128 #define IRQM_CGT_RESET          (1 << 1)        /* Reset CGT */
129 #define IRQM_CGT_PAUSE          (1 << 3)        /* Pause CGT */
130 #define IRQM_ADC_ABOUT_CNT      (1 << 4)        /* About Counter out */
131 #define IRQM_ADC_DELAY_CNT      (1 << 5)        /* Delay Counter out */
132 #define IRQM_ADC_SAMPLE_CNT     (1 << 6)        /* ADC Sample Counter */
133 #define IRQM_DAC1_UCNT          (1 << 7)        /* DAC1 Update Counter */
134 #define IRQM_DAC2_UCNT          (1 << 8)        /* DAC2 Update Counter */
135 #define IRQM_UTC1               (1 << 9)        /* User TC1 out */
136 #define IRQM_UTC1_INV           (1 << 10)       /* User TC1 out, inverted */
137 #define IRQM_UTC2               (1 << 11)       /* User TC2 out */
138 #define IRQM_DIGITAL_IT         (1 << 12)       /* Digital Interrupt */
139 #define IRQM_EXTERNAL_IT        (1 << 13)       /* External Interrupt */
140 #define IRQM_ETRIG_RISING       (1 << 14)       /* Ext Trigger rising-edge */
141 #define IRQM_ETRIG_FALLING      (1 << 15)       /* Ext Trigger falling-edge */
142 #define LAS0_CLEAR              0x0034  /* Clear/Set Interrupt Clear Mask */
143 #define LAS0_OVERRUN            0x0038  /* Pending interrupts/Clear Overrun */
144 #define LAS0_PCLK               0x0040  /* Pacer Clock (24bit) */
145 #define LAS0_BCLK               0x0044  /* Burst Clock (10bit) */
146 #define LAS0_ADC_SCNT           0x0048  /* A/D Sample counter (10bit) */
147 #define LAS0_DAC1_UCNT          0x004c  /* D/A1 Update counter (10 bit) */
148 #define LAS0_DAC2_UCNT          0x0050  /* D/A2 Update counter (10 bit) */
149 #define LAS0_DCNT               0x0054  /* Delay counter (16 bit) */
150 #define LAS0_ACNT               0x0058  /* About counter (16 bit) */
151 #define LAS0_DAC_CLK            0x005c  /* DAC clock (16bit) */
152 #define LAS0_UTC0               0x0060  /* 8254 TC Counter 0 */
153 #define LAS0_UTC1               0x0064  /* 8254 TC Counter 1 */
154 #define LAS0_UTC2               0x0068  /* 8254 TC Counter 2 */
155 #define LAS0_UTC_CTRL           0x006c  /* 8254 TC Control */
156 #define LAS0_DIO0               0x0070  /* Digital I/O Port 0 */
157 #define LAS0_DIO1               0x0074  /* Digital I/O Port 1 */
158 #define LAS0_DIO0_CTRL          0x0078  /* Digital I/O Control */
159 #define LAS0_DIO_STATUS         0x007c  /* Digital I/O Status */
160 #define LAS0_BOARD_RESET        0x0100  /* Board reset */
161 #define LAS0_DMA0_SRC           0x0104  /* DMA 0 Sources select */
162 #define LAS0_DMA1_SRC           0x0108  /* DMA 1 Sources select */
163 #define LAS0_ADC_CONVERSION     0x010c  /* A/D Conversion Signal select */
164 #define LAS0_BURST_START        0x0110  /* Burst Clock Start Trigger select */
165 #define LAS0_PACER_START        0x0114  /* Pacer Clock Start Trigger select */
166 #define LAS0_PACER_STOP         0x0118  /* Pacer Clock Stop Trigger select */
167 #define LAS0_ACNT_STOP_ENABLE   0x011c  /* About Counter Stop Enable */
168 #define LAS0_PACER_REPEAT       0x0120  /* Pacer Start Trigger Mode select */
169 #define LAS0_DIN_START          0x0124  /* HiSpd DI Sampling Signal select */
170 #define LAS0_DIN_FIFO_CLEAR     0x0128  /* Digital Input FIFO Clear */
171 #define LAS0_ADC_FIFO_CLEAR     0x012c  /* A/D FIFO Clear */
172 #define LAS0_CGT_WRITE          0x0130  /* Channel Gain Table Write */
173 #define LAS0_CGL_WRITE          0x0134  /* Channel Gain Latch Write */
174 #define LAS0_CG_DATA            0x0138  /* Digital Table Write */
175 #define LAS0_CGT_ENABLE         0x013c  /* Channel Gain Table Enable */
176 #define LAS0_CG_ENABLE          0x0140  /* Digital Table Enable */
177 #define LAS0_CGT_PAUSE          0x0144  /* Table Pause Enable */
178 #define LAS0_CGT_RESET          0x0148  /* Reset Channel Gain Table */
179 #define LAS0_CGT_CLEAR          0x014c  /* Clear Channel Gain Table */
180 #define LAS0_DAC1_CTRL          0x0150  /* D/A1 output type/range */
181 #define LAS0_DAC1_SRC           0x0154  /* D/A1 update source */
182 #define LAS0_DAC1_CYCLE         0x0158  /* D/A1 cycle mode */
183 #define LAS0_DAC1_RESET         0x015c  /* D/A1 FIFO reset */
184 #define LAS0_DAC1_FIFO_CLEAR    0x0160  /* D/A1 FIFO clear */
185 #define LAS0_DAC2_CTRL          0x0164  /* D/A2 output type/range */
186 #define LAS0_DAC2_SRC           0x0168  /* D/A2 update source */
187 #define LAS0_DAC2_CYCLE         0x016c  /* D/A2 cycle mode */
188 #define LAS0_DAC2_RESET         0x0170  /* D/A2 FIFO reset */
189 #define LAS0_DAC2_FIFO_CLEAR    0x0174  /* D/A2 FIFO clear */
190 #define LAS0_ADC_SCNT_SRC       0x0178  /* A/D Sample Counter Source select */
191 #define LAS0_PACER_SELECT       0x0180  /* Pacer Clock select */
192 #define LAS0_SBUS0_SRC          0x0184  /* SyncBus 0 Source select */
193 #define LAS0_SBUS0_ENABLE       0x0188  /* SyncBus 0 enable */
194 #define LAS0_SBUS1_SRC          0x018c  /* SyncBus 1 Source select */
195 #define LAS0_SBUS1_ENABLE       0x0190  /* SyncBus 1 enable */
196 #define LAS0_SBUS2_SRC          0x0198  /* SyncBus 2 Source select */
197 #define LAS0_SBUS2_ENABLE       0x019c  /* SyncBus 2 enable */
198 #define LAS0_ETRG_POLARITY      0x01a4  /* Ext. Trigger polarity select */
199 #define LAS0_EINT_POLARITY      0x01a8  /* Ext. Interrupt polarity select */
200 #define LAS0_UTC0_CLOCK         0x01ac  /* UTC0 Clock select */
201 #define LAS0_UTC0_GATE          0x01b0  /* UTC0 Gate select */
202 #define LAS0_UTC1_CLOCK         0x01b4  /* UTC1 Clock select */
203 #define LAS0_UTC1_GATE          0x01b8  /* UTC1 Gate select */
204 #define LAS0_UTC2_CLOCK         0x01bc  /* UTC2 Clock select */
205 #define LAS0_UTC2_GATE          0x01c0  /* UTC2 Gate select */
206 #define LAS0_UOUT0_SELECT       0x01c4  /* User Output 0 source select */
207 #define LAS0_UOUT1_SELECT       0x01c8  /* User Output 1 source select */
208 #define LAS0_DMA0_RESET         0x01cc  /* DMA0 Request state machine reset */
209 #define LAS0_DMA1_RESET         0x01d0  /* DMA1 Request state machine reset */
210
211 /*
212  * Local Address Space 1 Offsets
213  */
214 #define LAS1_ADC_FIFO           0x0000  /* A/D FIFO (16bit) */
215 #define LAS1_HDIO_FIFO          0x0004  /* HiSpd DI FIFO (16bit) */
216 #define LAS1_DAC1_FIFO          0x0008  /* D/A1 FIFO (16bit) */
217 #define LAS1_DAC2_FIFO          0x000c  /* D/A2 FIFO (16bit) */
218
219 /*======================================================================
220   Driver specific stuff (tunable)
221 ======================================================================*/
222
223 /* We really only need 2 buffers.  More than that means being much
224    smarter about knowing which ones are full. */
225 #define DMA_CHAIN_COUNT 2       /* max DMA segments/buffers in a ring (min 2) */
226
227 /* Target period for periodic transfers.  This sets the user read latency. */
228 /* Note: There are certain rates where we give this up and transfer 1/2 FIFO */
229 /* If this is too low, efficiency is poor */
230 #define TRANS_TARGET_PERIOD 10000000    /* 10 ms (in nanoseconds) */
231
232 /* Set a practical limit on how long a list to support (affects memory use) */
233 /* The board support a channel list up to the FIFO length (1K or 8K) */
234 #define RTD_MAX_CHANLIST        128     /* max channel list that we allow */
235
236 /*======================================================================
237   Board specific stuff
238 ======================================================================*/
239
240 #define RTD_CLOCK_RATE  8000000 /* 8Mhz onboard clock */
241 #define RTD_CLOCK_BASE  125     /* clock period in ns */
242
243 /* Note: these speed are slower than the spec, but fit the counter resolution*/
244 #define RTD_MAX_SPEED   1625    /* when sampling, in nanoseconds */
245 /* max speed if we don't have to wait for settling */
246 #define RTD_MAX_SPEED_1 875     /* if single channel, in nanoseconds */
247
248 #define RTD_MIN_SPEED   2097151875      /* (24bit counter) in nanoseconds */
249 /* min speed when only 1 channel (no burst counter) */
250 #define RTD_MIN_SPEED_1 5000000 /* 200Hz, in nanoseconds */
251
252 /* Setup continuous ring of 1/2 FIFO transfers.  See RTD manual p91 */
253 #define DMA_MODE_BITS (\
254                        PLX_LOCAL_BUS_16_WIDE_BITS \
255                        | PLX_DMA_EN_READYIN_BIT \
256                        | PLX_DMA_LOCAL_BURST_EN_BIT \
257                        | PLX_EN_CHAIN_BIT \
258                        | PLX_DMA_INTR_PCI_BIT \
259                        | PLX_LOCAL_ADDR_CONST_BIT \
260                        | PLX_DEMAND_MODE_BIT)
261
262 #define DMA_TRANSFER_BITS (\
263 /* descriptors in PCI memory*/  PLX_DESC_IN_PCI_BIT \
264 /* interrupt at end of block */ | PLX_INTR_TERM_COUNT \
265 /* from board to PCI */         | PLX_XFER_LOCAL_TO_PCI)
266
267 /*======================================================================
268   Comedi specific stuff
269 ======================================================================*/
270
271 /*
272  * The board has 3 input modes and the gains of 1,2,4,...32 (, 64, 128)
273  */
274 static const struct comedi_lrange rtd_ai_7520_range = {
275         18, {
276                 /* +-5V input range gain steps */
277                 BIP_RANGE(5.0),
278                 BIP_RANGE(5.0 / 2),
279                 BIP_RANGE(5.0 / 4),
280                 BIP_RANGE(5.0 / 8),
281                 BIP_RANGE(5.0 / 16),
282                 BIP_RANGE(5.0 / 32),
283                 /* +-10V input range gain steps */
284                 BIP_RANGE(10.0),
285                 BIP_RANGE(10.0 / 2),
286                 BIP_RANGE(10.0 / 4),
287                 BIP_RANGE(10.0 / 8),
288                 BIP_RANGE(10.0 / 16),
289                 BIP_RANGE(10.0 / 32),
290                 /* +10V input range gain steps */
291                 UNI_RANGE(10.0),
292                 UNI_RANGE(10.0 / 2),
293                 UNI_RANGE(10.0 / 4),
294                 UNI_RANGE(10.0 / 8),
295                 UNI_RANGE(10.0 / 16),
296                 UNI_RANGE(10.0 / 32),
297         }
298 };
299
300 /* PCI4520 has two more gains (6 more entries) */
301 static const struct comedi_lrange rtd_ai_4520_range = {
302         24, {
303                 /* +-5V input range gain steps */
304                 BIP_RANGE(5.0),
305                 BIP_RANGE(5.0 / 2),
306                 BIP_RANGE(5.0 / 4),
307                 BIP_RANGE(5.0 / 8),
308                 BIP_RANGE(5.0 / 16),
309                 BIP_RANGE(5.0 / 32),
310                 BIP_RANGE(5.0 / 64),
311                 BIP_RANGE(5.0 / 128),
312                 /* +-10V input range gain steps */
313                 BIP_RANGE(10.0),
314                 BIP_RANGE(10.0 / 2),
315                 BIP_RANGE(10.0 / 4),
316                 BIP_RANGE(10.0 / 8),
317                 BIP_RANGE(10.0 / 16),
318                 BIP_RANGE(10.0 / 32),
319                 BIP_RANGE(10.0 / 64),
320                 BIP_RANGE(10.0 / 128),
321                 /* +10V input range gain steps */
322                 UNI_RANGE(10.0),
323                 UNI_RANGE(10.0 / 2),
324                 UNI_RANGE(10.0 / 4),
325                 UNI_RANGE(10.0 / 8),
326                 UNI_RANGE(10.0 / 16),
327                 UNI_RANGE(10.0 / 32),
328                 UNI_RANGE(10.0 / 64),
329                 UNI_RANGE(10.0 / 128),
330         }
331 };
332
333 /* Table order matches range values */
334 static const struct comedi_lrange rtd_ao_range = {
335         4, {
336                 UNI_RANGE(5),
337                 UNI_RANGE(10),
338                 BIP_RANGE(5),
339                 BIP_RANGE(10),
340         }
341 };
342
343 enum rtd_boardid {
344         BOARD_DM7520,
345         BOARD_PCI4520,
346 };
347
348 struct rtd_boardinfo {
349         const char *name;
350         int range_bip10;        /* start of +-10V range */
351         int range_uni10;        /* start of +10V range */
352         const struct comedi_lrange *ai_range;
353 };
354
355 static const struct rtd_boardinfo rtd520Boards[] = {
356         [BOARD_DM7520] = {
357                 .name           = "DM7520",
358                 .range_bip10    = 6,
359                 .range_uni10    = 12,
360                 .ai_range       = &rtd_ai_7520_range,
361         },
362         [BOARD_PCI4520] = {
363                 .name           = "PCI4520",
364                 .range_bip10    = 8,
365                 .range_uni10    = 16,
366                 .ai_range       = &rtd_ai_4520_range,
367         },
368 };
369
370 struct rtd_private {
371         /* memory mapped board structures */
372         void __iomem *las1;
373         void __iomem *lcfg;
374
375         long ai_count;          /* total transfer size (samples) */
376         int xfer_count;         /* # to transfer data. 0->1/2FIFO */
377         int flags;              /* flag event modes */
378         unsigned fifosz;
379 };
380
381 /* bit defines for "flags" */
382 #define SEND_EOS        0x01    /* send End Of Scan events */
383 #define DMA0_ACTIVE     0x02    /* DMA0 is active */
384 #define DMA1_ACTIVE     0x04    /* DMA1 is active */
385
386 /*
387   Given a desired period and the clock period (both in ns),
388   return the proper counter value (divider-1).
389   Sets the original period to be the true value.
390   Note: you have to check if the value is larger than the counter range!
391 */
392 static int rtd_ns_to_timer_base(unsigned int *nanosec,
393                                 unsigned int flags, int base)
394 {
395         int divider;
396
397         switch (flags & CMDF_ROUND_MASK) {
398         case CMDF_ROUND_NEAREST:
399         default:
400                 divider = (*nanosec + base / 2) / base;
401                 break;
402         case CMDF_ROUND_DOWN:
403                 divider = (*nanosec) / base;
404                 break;
405         case CMDF_ROUND_UP:
406                 divider = (*nanosec + base - 1) / base;
407                 break;
408         }
409         if (divider < 2)
410                 divider = 2;    /* min is divide by 2 */
411
412         /* Note: we don't check for max, because different timers
413            have different ranges */
414
415         *nanosec = base * divider;
416         return divider - 1;     /* countdown is divisor+1 */
417 }
418
419 /*
420   Given a desired period (in ns),
421   return the proper counter value (divider-1) for the internal clock.
422   Sets the original period to be the true value.
423 */
424 static int rtd_ns_to_timer(unsigned int *ns, unsigned int flags)
425 {
426         return rtd_ns_to_timer_base(ns, flags, RTD_CLOCK_BASE);
427 }
428
429 /*
430   Convert a single comedi channel-gain entry to a RTD520 table entry
431 */
432 static unsigned short rtd_convert_chan_gain(struct comedi_device *dev,
433                                             unsigned int chanspec, int index)
434 {
435         const struct rtd_boardinfo *board = dev->board_ptr;
436         unsigned int chan = CR_CHAN(chanspec);
437         unsigned int range = CR_RANGE(chanspec);
438         unsigned int aref = CR_AREF(chanspec);
439         unsigned short r = 0;
440
441         r |= chan & 0xf;
442
443         /* Note: we also setup the channel list bipolar flag array */
444         if (range < board->range_bip10) {
445                 /* +-5 range */
446                 r |= 0x000;
447                 r |= (range & 0x7) << 4;
448         } else if (range < board->range_uni10) {
449                 /* +-10 range */
450                 r |= 0x100;
451                 r |= ((range - board->range_bip10) & 0x7) << 4;
452         } else {
453                 /* +10 range */
454                 r |= 0x200;
455                 r |= ((range - board->range_uni10) & 0x7) << 4;
456         }
457
458         switch (aref) {
459         case AREF_GROUND:       /* on-board ground */
460                 break;
461
462         case AREF_COMMON:
463                 r |= 0x80;      /* ref external analog common */
464                 break;
465
466         case AREF_DIFF:
467                 r |= 0x400;     /* differential inputs */
468                 break;
469
470         case AREF_OTHER:        /* ??? */
471                 break;
472         }
473         return r;
474 }
475
476 /*
477   Setup the channel-gain table from a comedi list
478 */
479 static void rtd_load_channelgain_list(struct comedi_device *dev,
480                                       unsigned int n_chan, unsigned int *list)
481 {
482         if (n_chan > 1) {       /* setup channel gain table */
483                 int ii;
484
485                 writel(0, dev->mmio + LAS0_CGT_CLEAR);
486                 writel(1, dev->mmio + LAS0_CGT_ENABLE);
487                 for (ii = 0; ii < n_chan; ii++) {
488                         writel(rtd_convert_chan_gain(dev, list[ii], ii),
489                                dev->mmio + LAS0_CGT_WRITE);
490                 }
491         } else {                /* just use the channel gain latch */
492                 writel(0, dev->mmio + LAS0_CGT_ENABLE);
493                 writel(rtd_convert_chan_gain(dev, list[0], 0),
494                        dev->mmio + LAS0_CGL_WRITE);
495         }
496 }
497
498 /* determine fifo size by doing adc conversions until the fifo half
499 empty status flag clears */
500 static int rtd520_probe_fifo_depth(struct comedi_device *dev)
501 {
502         unsigned int chanspec = CR_PACK(0, 0, AREF_GROUND);
503         unsigned i;
504         static const unsigned limit = 0x2000;
505         unsigned fifo_size = 0;
506
507         writel(0, dev->mmio + LAS0_ADC_FIFO_CLEAR);
508         rtd_load_channelgain_list(dev, 1, &chanspec);
509         /* ADC conversion trigger source: SOFTWARE */
510         writel(0, dev->mmio + LAS0_ADC_CONVERSION);
511         /* convert  samples */
512         for (i = 0; i < limit; ++i) {
513                 unsigned fifo_status;
514                 /* trigger conversion */
515                 writew(0, dev->mmio + LAS0_ADC);
516                 udelay(1);
517                 fifo_status = readl(dev->mmio + LAS0_ADC);
518                 if ((fifo_status & FS_ADC_HEMPTY) == 0) {
519                         fifo_size = 2 * i;
520                         break;
521                 }
522         }
523         if (i == limit) {
524                 dev_info(dev->class_dev, "failed to probe fifo size.\n");
525                 return -EIO;
526         }
527         writel(0, dev->mmio + LAS0_ADC_FIFO_CLEAR);
528         if (fifo_size != 0x400 && fifo_size != 0x2000) {
529                 dev_info(dev->class_dev,
530                          "unexpected fifo size of %i, expected 1024 or 8192.\n",
531                          fifo_size);
532                 return -EIO;
533         }
534         return fifo_size;
535 }
536
537 static int rtd_ai_eoc(struct comedi_device *dev,
538                       struct comedi_subdevice *s,
539                       struct comedi_insn *insn,
540                       unsigned long context)
541 {
542         unsigned int status;
543
544         status = readl(dev->mmio + LAS0_ADC);
545         if (status & FS_ADC_NOT_EMPTY)
546                 return 0;
547         return -EBUSY;
548 }
549
550 static int rtd_ai_rinsn(struct comedi_device *dev,
551                         struct comedi_subdevice *s, struct comedi_insn *insn,
552                         unsigned int *data)
553 {
554         struct rtd_private *devpriv = dev->private;
555         unsigned int range = CR_RANGE(insn->chanspec);
556         int ret;
557         int n;
558
559         /* clear any old fifo data */
560         writel(0, dev->mmio + LAS0_ADC_FIFO_CLEAR);
561
562         /* write channel to multiplexer and clear channel gain table */
563         rtd_load_channelgain_list(dev, 1, &insn->chanspec);
564
565         /* ADC conversion trigger source: SOFTWARE */
566         writel(0, dev->mmio + LAS0_ADC_CONVERSION);
567
568         /* convert n samples */
569         for (n = 0; n < insn->n; n++) {
570                 unsigned short d;
571                 /* trigger conversion */
572                 writew(0, dev->mmio + LAS0_ADC);
573
574                 ret = comedi_timeout(dev, s, insn, rtd_ai_eoc, 0);
575                 if (ret)
576                         return ret;
577
578                 /* read data */
579                 d = readw(devpriv->las1 + LAS1_ADC_FIFO);
580                 d >>= 3;        /* low 3 bits are marker lines */
581
582                 /* convert bipolar data to comedi unsigned data */
583                 if (comedi_range_is_bipolar(s, range))
584                         d = comedi_offset_munge(s, d);
585
586                 data[n] = d & s->maxdata;
587         }
588
589         /* return the number of samples read/written */
590         return n;
591 }
592
593 /*
594   Get what we know is there.... Fast!
595   This uses 1/2 the bus cycles of read_dregs (below).
596
597   The manual claims that we can do a lword read, but it doesn't work here.
598 */
599 static int ai_read_n(struct comedi_device *dev, struct comedi_subdevice *s,
600                      int count)
601 {
602         struct rtd_private *devpriv = dev->private;
603         struct comedi_async *async = s->async;
604         struct comedi_cmd *cmd = &async->cmd;
605         int ii;
606
607         for (ii = 0; ii < count; ii++) {
608                 unsigned int range = CR_RANGE(cmd->chanlist[async->cur_chan]);
609                 unsigned short d;
610
611                 if (0 == devpriv->ai_count) {   /* done */
612                         d = readw(devpriv->las1 + LAS1_ADC_FIFO);
613                         continue;
614                 }
615
616                 d = readw(devpriv->las1 + LAS1_ADC_FIFO);
617                 d >>= 3;        /* low 3 bits are marker lines */
618
619                 /* convert bipolar data to comedi unsigned data */
620                 if (comedi_range_is_bipolar(s, range))
621                         d = comedi_offset_munge(s, d);
622                 d &= s->maxdata;
623
624                 if (!comedi_buf_write_samples(s, &d, 1))
625                         return -1;
626
627                 if (devpriv->ai_count > 0)      /* < 0, means read forever */
628                         devpriv->ai_count--;
629         }
630         return 0;
631 }
632
633 /*
634   Handle all rtd520 interrupts.
635   Runs atomically and is never re-entered.
636   This is a "slow handler";  other interrupts may be active.
637   The data conversion may someday happen in a "bottom half".
638 */
639 static irqreturn_t rtd_interrupt(int irq, void *d)
640 {
641         struct comedi_device *dev = d;
642         struct comedi_subdevice *s = dev->read_subdev;
643         struct rtd_private *devpriv = dev->private;
644         u32 overrun;
645         u16 status;
646         u16 fifo_status;
647
648         if (!dev->attached)
649                 return IRQ_NONE;
650
651         fifo_status = readl(dev->mmio + LAS0_ADC);
652         /* check for FIFO full, this automatically halts the ADC! */
653         if (!(fifo_status & FS_ADC_NOT_FULL))   /* 0 -> full */
654                 goto xfer_abort;
655
656         status = readw(dev->mmio + LAS0_IT);
657         /* if interrupt was not caused by our board, or handled above */
658         if (0 == status)
659                 return IRQ_HANDLED;
660
661         if (status & IRQM_ADC_ABOUT_CNT) {      /* sample count -> read FIFO */
662                 /*
663                  * since the priority interrupt controller may have queued
664                  * a sample counter interrupt, even though we have already
665                  * finished, we must handle the possibility that there is
666                  * no data here
667                  */
668                 if (!(fifo_status & FS_ADC_HEMPTY)) {
669                         /* FIFO half full */
670                         if (ai_read_n(dev, s, devpriv->fifosz / 2) < 0)
671                                 goto xfer_abort;
672
673                         if (0 == devpriv->ai_count)
674                                 goto xfer_done;
675                 } else if (devpriv->xfer_count > 0) {
676                         if (fifo_status & FS_ADC_NOT_EMPTY) {
677                                 /* FIFO not empty */
678                                 if (ai_read_n(dev, s, devpriv->xfer_count) < 0)
679                                         goto xfer_abort;
680
681                                 if (0 == devpriv->ai_count)
682                                         goto xfer_done;
683                         }
684                 }
685         }
686
687         overrun = readl(dev->mmio + LAS0_OVERRUN) & 0xffff;
688         if (overrun)
689                 goto xfer_abort;
690
691         /* clear the interrupt */
692         writew(status, dev->mmio + LAS0_CLEAR);
693         readw(dev->mmio + LAS0_CLEAR);
694
695         comedi_handle_events(dev, s);
696
697         return IRQ_HANDLED;
698
699 xfer_abort:
700         s->async->events |= COMEDI_CB_ERROR;
701
702 xfer_done:
703         s->async->events |= COMEDI_CB_EOA;
704
705         /* clear the interrupt */
706         status = readw(dev->mmio + LAS0_IT);
707         writew(status, dev->mmio + LAS0_CLEAR);
708         readw(dev->mmio + LAS0_CLEAR);
709
710         fifo_status = readl(dev->mmio + LAS0_ADC);
711         overrun = readl(dev->mmio + LAS0_OVERRUN) & 0xffff;
712
713         comedi_handle_events(dev, s);
714
715         return IRQ_HANDLED;
716 }
717
718 /*
719   cmdtest tests a particular command to see if it is valid.
720   Using the cmdtest ioctl, a user can create a valid cmd
721   and then have it executed by the cmd ioctl (asynchronously).
722
723   cmdtest returns 1,2,3,4 or 0, depending on which tests
724   the command passes.
725 */
726
727 static int rtd_ai_cmdtest(struct comedi_device *dev,
728                           struct comedi_subdevice *s, struct comedi_cmd *cmd)
729 {
730         int err = 0;
731         unsigned int arg;
732
733         /* Step 1 : check if triggers are trivially valid */
734
735         err |= comedi_check_trigger_src(&cmd->start_src, TRIG_NOW);
736         err |= comedi_check_trigger_src(&cmd->scan_begin_src,
737                                         TRIG_TIMER | TRIG_EXT);
738         err |= comedi_check_trigger_src(&cmd->convert_src,
739                                         TRIG_TIMER | TRIG_EXT);
740         err |= comedi_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT);
741         err |= comedi_check_trigger_src(&cmd->stop_src, TRIG_COUNT | TRIG_NONE);
742
743         if (err)
744                 return 1;
745
746         /* Step 2a : make sure trigger sources are unique */
747
748         err |= comedi_check_trigger_is_unique(cmd->scan_begin_src);
749         err |= comedi_check_trigger_is_unique(cmd->convert_src);
750         err |= comedi_check_trigger_is_unique(cmd->stop_src);
751
752         /* Step 2b : and mutually compatible */
753
754         if (err)
755                 return 2;
756
757         /* Step 3: check if arguments are trivially valid */
758
759         err |= comedi_check_trigger_arg_is(&cmd->start_arg, 0);
760
761         if (cmd->scan_begin_src == TRIG_TIMER) {
762                 /* Note: these are time periods, not actual rates */
763                 if (1 == cmd->chanlist_len) {   /* no scanning */
764                         if (comedi_check_trigger_arg_min(&cmd->scan_begin_arg,
765                                                          RTD_MAX_SPEED_1)) {
766                                 rtd_ns_to_timer(&cmd->scan_begin_arg,
767                                                 CMDF_ROUND_UP);
768                                 err |= -EINVAL;
769                         }
770                         if (comedi_check_trigger_arg_max(&cmd->scan_begin_arg,
771                                                          RTD_MIN_SPEED_1)) {
772                                 rtd_ns_to_timer(&cmd->scan_begin_arg,
773                                                 CMDF_ROUND_DOWN);
774                                 err |= -EINVAL;
775                         }
776                 } else {
777                         if (comedi_check_trigger_arg_min(&cmd->scan_begin_arg,
778                                                          RTD_MAX_SPEED)) {
779                                 rtd_ns_to_timer(&cmd->scan_begin_arg,
780                                                 CMDF_ROUND_UP);
781                                 err |= -EINVAL;
782                         }
783                         if (comedi_check_trigger_arg_max(&cmd->scan_begin_arg,
784                                                          RTD_MIN_SPEED)) {
785                                 rtd_ns_to_timer(&cmd->scan_begin_arg,
786                                                 CMDF_ROUND_DOWN);
787                                 err |= -EINVAL;
788                         }
789                 }
790         } else {
791                 /* external trigger */
792                 /* should be level/edge, hi/lo specification here */
793                 /* should specify multiple external triggers */
794                 err |= comedi_check_trigger_arg_max(&cmd->scan_begin_arg, 9);
795         }
796
797         if (cmd->convert_src == TRIG_TIMER) {
798                 if (1 == cmd->chanlist_len) {   /* no scanning */
799                         if (comedi_check_trigger_arg_min(&cmd->convert_arg,
800                                                          RTD_MAX_SPEED_1)) {
801                                 rtd_ns_to_timer(&cmd->convert_arg,
802                                                 CMDF_ROUND_UP);
803                                 err |= -EINVAL;
804                         }
805                         if (comedi_check_trigger_arg_max(&cmd->convert_arg,
806                                                          RTD_MIN_SPEED_1)) {
807                                 rtd_ns_to_timer(&cmd->convert_arg,
808                                                 CMDF_ROUND_DOWN);
809                                 err |= -EINVAL;
810                         }
811                 } else {
812                         if (comedi_check_trigger_arg_min(&cmd->convert_arg,
813                                                          RTD_MAX_SPEED)) {
814                                 rtd_ns_to_timer(&cmd->convert_arg,
815                                                 CMDF_ROUND_UP);
816                                 err |= -EINVAL;
817                         }
818                         if (comedi_check_trigger_arg_max(&cmd->convert_arg,
819                                                          RTD_MIN_SPEED)) {
820                                 rtd_ns_to_timer(&cmd->convert_arg,
821                                                 CMDF_ROUND_DOWN);
822                                 err |= -EINVAL;
823                         }
824                 }
825         } else {
826                 /* external trigger */
827                 /* see above */
828                 err |= comedi_check_trigger_arg_max(&cmd->convert_arg, 9);
829         }
830
831         err |= comedi_check_trigger_arg_is(&cmd->scan_end_arg,
832                                            cmd->chanlist_len);
833
834         if (cmd->stop_src == TRIG_COUNT)
835                 err |= comedi_check_trigger_arg_min(&cmd->stop_arg, 1);
836         else    /* TRIG_NONE */
837                 err |= comedi_check_trigger_arg_is(&cmd->stop_arg, 0);
838
839         if (err)
840                 return 3;
841
842         /* step 4: fix up any arguments */
843
844         if (cmd->scan_begin_src == TRIG_TIMER) {
845                 arg = cmd->scan_begin_arg;
846                 rtd_ns_to_timer(&arg, cmd->flags);
847                 err |= comedi_check_trigger_arg_is(&cmd->scan_begin_arg, arg);
848         }
849
850         if (cmd->convert_src == TRIG_TIMER) {
851                 arg = cmd->convert_arg;
852                 rtd_ns_to_timer(&arg, cmd->flags);
853                 err |= comedi_check_trigger_arg_is(&cmd->convert_arg, arg);
854
855                 if (cmd->scan_begin_src == TRIG_TIMER) {
856                         arg = cmd->convert_arg * cmd->scan_end_arg;
857                         err |= comedi_check_trigger_arg_min(&cmd->
858                                                             scan_begin_arg,
859                                                             arg);
860                 }
861         }
862
863         if (err)
864                 return 4;
865
866         return 0;
867 }
868
869 /*
870   Execute a analog in command with many possible triggering options.
871   The data get stored in the async structure of the subdevice.
872   This is usually done by an interrupt handler.
873   Userland gets to the data using read calls.
874 */
875 static int rtd_ai_cmd(struct comedi_device *dev, struct comedi_subdevice *s)
876 {
877         struct rtd_private *devpriv = dev->private;
878         struct comedi_cmd *cmd = &s->async->cmd;
879         int timer;
880
881         /* stop anything currently running */
882         /* pacer stop source: SOFTWARE */
883         writel(0, dev->mmio + LAS0_PACER_STOP);
884         writel(0, dev->mmio + LAS0_PACER);      /* stop pacer */
885         writel(0, dev->mmio + LAS0_ADC_CONVERSION);
886         writew(0, dev->mmio + LAS0_IT);
887         writel(0, dev->mmio + LAS0_ADC_FIFO_CLEAR);
888         writel(0, dev->mmio + LAS0_OVERRUN);
889
890         /* start configuration */
891         /* load channel list and reset CGT */
892         rtd_load_channelgain_list(dev, cmd->chanlist_len, cmd->chanlist);
893
894         /* setup the common case and override if needed */
895         if (cmd->chanlist_len > 1) {
896                 /* pacer start source: SOFTWARE */
897                 writel(0, dev->mmio + LAS0_PACER_START);
898                 /* burst trigger source: PACER */
899                 writel(1, dev->mmio + LAS0_BURST_START);
900                 /* ADC conversion trigger source: BURST */
901                 writel(2, dev->mmio + LAS0_ADC_CONVERSION);
902         } else {                /* single channel */
903                 /* pacer start source: SOFTWARE */
904                 writel(0, dev->mmio + LAS0_PACER_START);
905                 /* ADC conversion trigger source: PACER */
906                 writel(1, dev->mmio + LAS0_ADC_CONVERSION);
907         }
908         writel((devpriv->fifosz / 2 - 1) & 0xffff, dev->mmio + LAS0_ACNT);
909
910         if (TRIG_TIMER == cmd->scan_begin_src) {
911                 /* scan_begin_arg is in nanoseconds */
912                 /* find out how many samples to wait before transferring */
913                 if (cmd->flags & CMDF_WAKE_EOS) {
914                         /*
915                          * this may generate un-sustainable interrupt rates
916                          * the application is responsible for doing the
917                          * right thing
918                          */
919                         devpriv->xfer_count = cmd->chanlist_len;
920                         devpriv->flags |= SEND_EOS;
921                 } else {
922                         /* arrange to transfer data periodically */
923                         devpriv->xfer_count =
924                             (TRANS_TARGET_PERIOD * cmd->chanlist_len) /
925                             cmd->scan_begin_arg;
926                         if (devpriv->xfer_count < cmd->chanlist_len) {
927                                 /* transfer after each scan (and avoid 0) */
928                                 devpriv->xfer_count = cmd->chanlist_len;
929                         } else {        /* make a multiple of scan length */
930                                 devpriv->xfer_count =
931                                     (devpriv->xfer_count +
932                                      cmd->chanlist_len - 1)
933                                     / cmd->chanlist_len;
934                                 devpriv->xfer_count *= cmd->chanlist_len;
935                         }
936                         devpriv->flags |= SEND_EOS;
937                 }
938                 if (devpriv->xfer_count >= (devpriv->fifosz / 2)) {
939                         /* out of counter range, use 1/2 fifo instead */
940                         devpriv->xfer_count = 0;
941                         devpriv->flags &= ~SEND_EOS;
942                 } else {
943                         /* interrupt for each transfer */
944                         writel((devpriv->xfer_count - 1) & 0xffff,
945                                dev->mmio + LAS0_ACNT);
946                 }
947         } else {                /* unknown timing, just use 1/2 FIFO */
948                 devpriv->xfer_count = 0;
949                 devpriv->flags &= ~SEND_EOS;
950         }
951         /* pacer clock source: INTERNAL 8MHz */
952         writel(1, dev->mmio + LAS0_PACER_SELECT);
953         /* just interrupt, don't stop */
954         writel(1, dev->mmio + LAS0_ACNT_STOP_ENABLE);
955
956         /* BUG??? these look like enumerated values, but they are bit fields */
957
958         /* First, setup when to stop */
959         switch (cmd->stop_src) {
960         case TRIG_COUNT:        /* stop after N scans */
961                 devpriv->ai_count = cmd->stop_arg * cmd->chanlist_len;
962                 if ((devpriv->xfer_count > 0)
963                     && (devpriv->xfer_count > devpriv->ai_count)) {
964                         devpriv->xfer_count = devpriv->ai_count;
965                 }
966                 break;
967
968         case TRIG_NONE: /* stop when cancel is called */
969                 devpriv->ai_count = -1; /* read forever */
970                 break;
971         }
972
973         /* Scan timing */
974         switch (cmd->scan_begin_src) {
975         case TRIG_TIMER:        /* periodic scanning */
976                 timer = rtd_ns_to_timer(&cmd->scan_begin_arg,
977                                         CMDF_ROUND_NEAREST);
978                 /* set PACER clock */
979                 writel(timer & 0xffffff, dev->mmio + LAS0_PCLK);
980
981                 break;
982
983         case TRIG_EXT:
984                 /* pacer start source: EXTERNAL */
985                 writel(1, dev->mmio + LAS0_PACER_START);
986                 break;
987         }
988
989         /* Sample timing within a scan */
990         switch (cmd->convert_src) {
991         case TRIG_TIMER:        /* periodic */
992                 if (cmd->chanlist_len > 1) {
993                         /* only needed for multi-channel */
994                         timer = rtd_ns_to_timer(&cmd->convert_arg,
995                                                 CMDF_ROUND_NEAREST);
996                         /* setup BURST clock */
997                         writel(timer & 0x3ff, dev->mmio + LAS0_BCLK);
998                 }
999
1000                 break;
1001
1002         case TRIG_EXT:          /* external */
1003                 /* burst trigger source: EXTERNAL */
1004                 writel(2, dev->mmio + LAS0_BURST_START);
1005                 break;
1006         }
1007         /* end configuration */
1008
1009         /* This doesn't seem to work.  There is no way to clear an interrupt
1010            that the priority controller has queued! */
1011         writew(~0, dev->mmio + LAS0_CLEAR);
1012         readw(dev->mmio + LAS0_CLEAR);
1013
1014         /* TODO: allow multiple interrupt sources */
1015         /* transfer every N samples */
1016         writew(IRQM_ADC_ABOUT_CNT, dev->mmio + LAS0_IT);
1017
1018         /* BUG: start_src is ASSUMED to be TRIG_NOW */
1019         /* BUG? it seems like things are running before the "start" */
1020         readl(dev->mmio + LAS0_PACER);  /* start pacer */
1021         return 0;
1022 }
1023
1024 /*
1025   Stop a running data acquisition.
1026 */
1027 static int rtd_ai_cancel(struct comedi_device *dev, struct comedi_subdevice *s)
1028 {
1029         struct rtd_private *devpriv = dev->private;
1030
1031         /* pacer stop source: SOFTWARE */
1032         writel(0, dev->mmio + LAS0_PACER_STOP);
1033         writel(0, dev->mmio + LAS0_PACER);      /* stop pacer */
1034         writel(0, dev->mmio + LAS0_ADC_CONVERSION);
1035         writew(0, dev->mmio + LAS0_IT);
1036         devpriv->ai_count = 0;  /* stop and don't transfer any more */
1037         writel(0, dev->mmio + LAS0_ADC_FIFO_CLEAR);
1038         return 0;
1039 }
1040
1041 static int rtd_ao_eoc(struct comedi_device *dev,
1042                       struct comedi_subdevice *s,
1043                       struct comedi_insn *insn,
1044                       unsigned long context)
1045 {
1046         unsigned int chan = CR_CHAN(insn->chanspec);
1047         unsigned int bit = (chan == 0) ? FS_DAC1_NOT_EMPTY : FS_DAC2_NOT_EMPTY;
1048         unsigned int status;
1049
1050         status = readl(dev->mmio + LAS0_ADC);
1051         if (status & bit)
1052                 return 0;
1053         return -EBUSY;
1054 }
1055
1056 static int rtd_ao_winsn(struct comedi_device *dev,
1057                         struct comedi_subdevice *s, struct comedi_insn *insn,
1058                         unsigned int *data)
1059 {
1060         struct rtd_private *devpriv = dev->private;
1061         int i;
1062         int chan = CR_CHAN(insn->chanspec);
1063         int range = CR_RANGE(insn->chanspec);
1064         int ret;
1065
1066         /* Configure the output range (table index matches the range values) */
1067         writew(range & 7,
1068                dev->mmio + ((chan == 0) ? LAS0_DAC1_CTRL : LAS0_DAC2_CTRL));
1069
1070         /* Writing a list of values to an AO channel is probably not
1071          * very useful, but that's how the interface is defined. */
1072         for (i = 0; i < insn->n; ++i) {
1073                 int val = data[i] << 3;
1074
1075                 /* VERIFY: comedi range and offset conversions */
1076
1077                 if ((range > 1) /* bipolar */
1078                     && (data[i] < 2048)) {
1079                         /* offset and sign extend */
1080                         val = (((int)data[i]) - 2048) << 3;
1081                 } else {        /* unipolor */
1082                         val = data[i] << 3;
1083                 }
1084
1085                 /* a typical programming sequence */
1086                 writew(val, devpriv->las1 +
1087                         ((chan == 0) ? LAS1_DAC1_FIFO : LAS1_DAC2_FIFO));
1088                 writew(0, dev->mmio + ((chan == 0) ? LAS0_DAC1 : LAS0_DAC2));
1089
1090                 s->readback[chan] = data[i];
1091
1092                 ret = comedi_timeout(dev, s, insn, rtd_ao_eoc, 0);
1093                 if (ret)
1094                         return ret;
1095         }
1096
1097         /* return the number of samples read/written */
1098         return i;
1099 }
1100
1101 static int rtd_dio_insn_bits(struct comedi_device *dev,
1102                              struct comedi_subdevice *s,
1103                              struct comedi_insn *insn,
1104                              unsigned int *data)
1105 {
1106         if (comedi_dio_update_state(s, data))
1107                 writew(s->state & 0xff, dev->mmio + LAS0_DIO0);
1108
1109         data[1] = readw(dev->mmio + LAS0_DIO0) & 0xff;
1110
1111         return insn->n;
1112 }
1113
1114 static int rtd_dio_insn_config(struct comedi_device *dev,
1115                                struct comedi_subdevice *s,
1116                                struct comedi_insn *insn,
1117                                unsigned int *data)
1118 {
1119         int ret;
1120
1121         ret = comedi_dio_insn_config(dev, s, insn, data, 0);
1122         if (ret)
1123                 return ret;
1124
1125         /* TODO support digital match interrupts and strobes */
1126
1127         /* set direction */
1128         writew(0x01, dev->mmio + LAS0_DIO_STATUS);
1129         writew(s->io_bits & 0xff, dev->mmio + LAS0_DIO0_CTRL);
1130
1131         /* clear interrupts */
1132         writew(0x00, dev->mmio + LAS0_DIO_STATUS);
1133
1134         /* port1 can only be all input or all output */
1135
1136         /* there are also 2 user input lines and 2 user output lines */
1137
1138         return insn->n;
1139 }
1140
1141 static void rtd_reset(struct comedi_device *dev)
1142 {
1143         struct rtd_private *devpriv = dev->private;
1144
1145         writel(0, dev->mmio + LAS0_BOARD_RESET);
1146         udelay(100);            /* needed? */
1147         writel(0, devpriv->lcfg + PLX_INTRCS_REG);
1148         writew(0, dev->mmio + LAS0_IT);
1149         writew(~0, dev->mmio + LAS0_CLEAR);
1150         readw(dev->mmio + LAS0_CLEAR);
1151 }
1152
1153 /*
1154  * initialize board, per RTD spec
1155  * also, initialize shadow registers
1156  */
1157 static void rtd_init_board(struct comedi_device *dev)
1158 {
1159         rtd_reset(dev);
1160
1161         writel(0, dev->mmio + LAS0_OVERRUN);
1162         writel(0, dev->mmio + LAS0_CGT_CLEAR);
1163         writel(0, dev->mmio + LAS0_ADC_FIFO_CLEAR);
1164         writel(0, dev->mmio + LAS0_DAC1_RESET);
1165         writel(0, dev->mmio + LAS0_DAC2_RESET);
1166         /* clear digital IO fifo */
1167         writew(0, dev->mmio + LAS0_DIO_STATUS);
1168         writeb((0 << 6) | 0x30, dev->mmio + LAS0_UTC_CTRL);
1169         writeb((1 << 6) | 0x30, dev->mmio + LAS0_UTC_CTRL);
1170         writeb((2 << 6) | 0x30, dev->mmio + LAS0_UTC_CTRL);
1171         writeb((3 << 6) | 0x00, dev->mmio + LAS0_UTC_CTRL);
1172         /* TODO: set user out source ??? */
1173 }
1174
1175 /* The RTD driver does this */
1176 static void rtd_pci_latency_quirk(struct comedi_device *dev,
1177                                   struct pci_dev *pcidev)
1178 {
1179         unsigned char pci_latency;
1180
1181         pci_read_config_byte(pcidev, PCI_LATENCY_TIMER, &pci_latency);
1182         if (pci_latency < 32) {
1183                 dev_info(dev->class_dev,
1184                          "PCI latency changed from %d to %d\n",
1185                          pci_latency, 32);
1186                 pci_write_config_byte(pcidev, PCI_LATENCY_TIMER, 32);
1187         }
1188 }
1189
1190 static int rtd_auto_attach(struct comedi_device *dev,
1191                            unsigned long context)
1192 {
1193         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
1194         const struct rtd_boardinfo *board = NULL;
1195         struct rtd_private *devpriv;
1196         struct comedi_subdevice *s;
1197         int ret;
1198
1199         if (context < ARRAY_SIZE(rtd520Boards))
1200                 board = &rtd520Boards[context];
1201         if (!board)
1202                 return -ENODEV;
1203         dev->board_ptr = board;
1204         dev->board_name = board->name;
1205
1206         devpriv = comedi_alloc_devpriv(dev, sizeof(*devpriv));
1207         if (!devpriv)
1208                 return -ENOMEM;
1209
1210         ret = comedi_pci_enable(dev);
1211         if (ret)
1212                 return ret;
1213
1214         dev->mmio = pci_ioremap_bar(pcidev, 2);
1215         devpriv->las1 = pci_ioremap_bar(pcidev, 3);
1216         devpriv->lcfg = pci_ioremap_bar(pcidev, 0);
1217         if (!dev->mmio || !devpriv->las1 || !devpriv->lcfg)
1218                 return -ENOMEM;
1219
1220         rtd_pci_latency_quirk(dev, pcidev);
1221
1222         if (pcidev->irq) {
1223                 ret = request_irq(pcidev->irq, rtd_interrupt, IRQF_SHARED,
1224                                   dev->board_name, dev);
1225                 if (ret == 0)
1226                         dev->irq = pcidev->irq;
1227         }
1228
1229         ret = comedi_alloc_subdevices(dev, 4);
1230         if (ret)
1231                 return ret;
1232
1233         s = &dev->subdevices[0];
1234         /* analog input subdevice */
1235         s->type         = COMEDI_SUBD_AI;
1236         s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_COMMON | SDF_DIFF;
1237         s->n_chan       = 16;
1238         s->maxdata      = 0x0fff;
1239         s->range_table  = board->ai_range;
1240         s->len_chanlist = RTD_MAX_CHANLIST;
1241         s->insn_read    = rtd_ai_rinsn;
1242         if (dev->irq) {
1243                 dev->read_subdev = s;
1244                 s->subdev_flags |= SDF_CMD_READ;
1245                 s->do_cmd       = rtd_ai_cmd;
1246                 s->do_cmdtest   = rtd_ai_cmdtest;
1247                 s->cancel       = rtd_ai_cancel;
1248         }
1249
1250         s = &dev->subdevices[1];
1251         /* analog output subdevice */
1252         s->type         = COMEDI_SUBD_AO;
1253         s->subdev_flags = SDF_WRITABLE;
1254         s->n_chan       = 2;
1255         s->maxdata      = 0x0fff;
1256         s->range_table  = &rtd_ao_range;
1257         s->insn_write   = rtd_ao_winsn;
1258
1259         ret = comedi_alloc_subdev_readback(s);
1260         if (ret)
1261                 return ret;
1262
1263         s = &dev->subdevices[2];
1264         /* digital i/o subdevice */
1265         s->type         = COMEDI_SUBD_DIO;
1266         s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
1267         /* we only support port 0 right now.  Ignoring port 1 and user IO */
1268         s->n_chan       = 8;
1269         s->maxdata      = 1;
1270         s->range_table  = &range_digital;
1271         s->insn_bits    = rtd_dio_insn_bits;
1272         s->insn_config  = rtd_dio_insn_config;
1273
1274         /* timer/counter subdevices (not currently supported) */
1275         s = &dev->subdevices[3];
1276         s->type         = COMEDI_SUBD_COUNTER;
1277         s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
1278         s->n_chan       = 3;
1279         s->maxdata      = 0xffff;
1280
1281         rtd_init_board(dev);
1282
1283         ret = rtd520_probe_fifo_depth(dev);
1284         if (ret < 0)
1285                 return ret;
1286         devpriv->fifosz = ret;
1287
1288         if (dev->irq)
1289                 writel(ICS_PIE | ICS_PLIE, devpriv->lcfg + PLX_INTRCS_REG);
1290
1291         return 0;
1292 }
1293
1294 static void rtd_detach(struct comedi_device *dev)
1295 {
1296         struct rtd_private *devpriv = dev->private;
1297
1298         if (devpriv) {
1299                 /* Shut down any board ops by resetting it */
1300                 if (dev->mmio && devpriv->lcfg)
1301                         rtd_reset(dev);
1302                 if (dev->irq)
1303                         free_irq(dev->irq, dev);
1304                 if (dev->mmio)
1305                         iounmap(dev->mmio);
1306                 if (devpriv->las1)
1307                         iounmap(devpriv->las1);
1308                 if (devpriv->lcfg)
1309                         iounmap(devpriv->lcfg);
1310         }
1311         comedi_pci_disable(dev);
1312 }
1313
1314 static struct comedi_driver rtd520_driver = {
1315         .driver_name    = "rtd520",
1316         .module         = THIS_MODULE,
1317         .auto_attach    = rtd_auto_attach,
1318         .detach         = rtd_detach,
1319 };
1320
1321 static int rtd520_pci_probe(struct pci_dev *dev,
1322                             const struct pci_device_id *id)
1323 {
1324         return comedi_pci_auto_config(dev, &rtd520_driver, id->driver_data);
1325 }
1326
1327 static const struct pci_device_id rtd520_pci_table[] = {
1328         { PCI_VDEVICE(RTD, 0x7520), BOARD_DM7520 },
1329         { PCI_VDEVICE(RTD, 0x4520), BOARD_PCI4520 },
1330         { 0 }
1331 };
1332 MODULE_DEVICE_TABLE(pci, rtd520_pci_table);
1333
1334 static struct pci_driver rtd520_pci_driver = {
1335         .name           = "rtd520",
1336         .id_table       = rtd520_pci_table,
1337         .probe          = rtd520_pci_probe,
1338         .remove         = comedi_pci_auto_unconfig,
1339 };
1340 module_comedi_pci_driver(rtd520_driver, rtd520_pci_driver);
1341
1342 MODULE_AUTHOR("Comedi http://www.comedi.org");
1343 MODULE_DESCRIPTION("Comedi low-level driver");
1344 MODULE_LICENSE("GPL");