]> Pileus Git - ~andy/linux/blob - drivers/staging/comedi/drivers/ni_atmio16d.c
staging: comedi: remove inline alloc_private()
[~andy/linux] / drivers / staging / comedi / drivers / ni_atmio16d.c
1 /*
2    comedi/drivers/ni_atmio16d.c
3    Hardware driver for National Instruments AT-MIO16D board
4    Copyright (C) 2000 Chris R. Baugher <baugher@enteract.com>
5
6    This program is free software; you can redistribute it and/or modify
7    it under the terms of the GNU General Public License as published by
8    the Free Software Foundation; either version 2 of the License, or
9    (at your option) any later version.
10
11    This program is distributed in the hope that it will be useful,
12    but WITHOUT ANY WARRANTY; without even the implied warranty of
13    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14    GNU General Public License for more details.
15
16    You should have received a copy of the GNU General Public License
17    along with this program; if not, write to the Free Software
18    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19
20  */
21 /*
22 Driver: ni_atmio16d
23 Description: National Instruments AT-MIO-16D
24 Author: Chris R. Baugher <baugher@enteract.com>
25 Status: unknown
26 Devices: [National Instruments] AT-MIO-16 (atmio16), AT-MIO-16D (atmio16d)
27 */
28 /*
29  * I must give credit here to Michal Dobes <dobes@tesnet.cz> who
30  * wrote the driver for Advantec's pcl812 boards. I used the interrupt
31  * handling code from his driver as an example for this one.
32  *
33  * Chris Baugher
34  * 5/1/2000
35  *
36  */
37
38 #include <linux/interrupt.h>
39 #include "../comedidev.h"
40
41 #include <linux/ioport.h>
42
43 #include "comedi_fc.h"
44 #include "8255.h"
45
46 /* Configuration and Status Registers */
47 #define COM_REG_1       0x00    /* wo 16 */
48 #define STAT_REG        0x00    /* ro 16 */
49 #define COM_REG_2       0x02    /* wo 16 */
50 /* Event Strobe Registers */
51 #define START_CONVERT_REG       0x08    /* wo 16 */
52 #define START_DAQ_REG           0x0A    /* wo 16 */
53 #define AD_CLEAR_REG            0x0C    /* wo 16 */
54 #define EXT_STROBE_REG          0x0E    /* wo 16 */
55 /* Analog Output Registers */
56 #define DAC0_REG                0x10    /* wo 16 */
57 #define DAC1_REG                0x12    /* wo 16 */
58 #define INT2CLR_REG             0x14    /* wo 16 */
59 /* Analog Input Registers */
60 #define MUX_CNTR_REG            0x04    /* wo 16 */
61 #define MUX_GAIN_REG            0x06    /* wo 16 */
62 #define AD_FIFO_REG             0x16    /* ro 16 */
63 #define DMA_TC_INT_CLR_REG      0x16    /* wo 16 */
64 /* AM9513A Counter/Timer Registers */
65 #define AM9513A_DATA_REG        0x18    /* rw 16 */
66 #define AM9513A_COM_REG         0x1A    /* wo 16 */
67 #define AM9513A_STAT_REG        0x1A    /* ro 16 */
68 /* MIO-16 Digital I/O Registers */
69 #define MIO_16_DIG_IN_REG       0x1C    /* ro 16 */
70 #define MIO_16_DIG_OUT_REG      0x1C    /* wo 16 */
71 /* RTSI Switch Registers */
72 #define RTSI_SW_SHIFT_REG       0x1E    /* wo 8 */
73 #define RTSI_SW_STROBE_REG      0x1F    /* wo 8 */
74 /* DIO-24 Registers */
75 #define DIO_24_PORTA_REG        0x00    /* rw 8 */
76 #define DIO_24_PORTB_REG        0x01    /* rw 8 */
77 #define DIO_24_PORTC_REG        0x02    /* rw 8 */
78 #define DIO_24_CNFG_REG         0x03    /* wo 8 */
79
80 /* Command Register bits */
81 #define COMREG1_2SCADC          0x0001
82 #define COMREG1_1632CNT         0x0002
83 #define COMREG1_SCANEN          0x0008
84 #define COMREG1_DAQEN           0x0010
85 #define COMREG1_DMAEN           0x0020
86 #define COMREG1_CONVINTEN       0x0080
87 #define COMREG2_SCN2            0x0010
88 #define COMREG2_INTEN           0x0080
89 #define COMREG2_DOUTEN0         0x0100
90 #define COMREG2_DOUTEN1         0x0200
91 /* Status Register bits */
92 #define STAT_AD_OVERRUN         0x0100
93 #define STAT_AD_OVERFLOW        0x0200
94 #define STAT_AD_DAQPROG         0x0800
95 #define STAT_AD_CONVAVAIL       0x2000
96 #define STAT_AD_DAQSTOPINT      0x4000
97 /* AM9513A Counter/Timer defines */
98 #define CLOCK_1_MHZ             0x8B25
99 #define CLOCK_100_KHZ   0x8C25
100 #define CLOCK_10_KHZ    0x8D25
101 #define CLOCK_1_KHZ             0x8E25
102 #define CLOCK_100_HZ    0x8F25
103 /* Other miscellaneous defines */
104 #define ATMIO16D_SIZE   32      /* bus address range */
105 #define ATMIO16D_TIMEOUT 10
106
107 struct atmio16_board_t {
108
109         const char *name;
110         int has_8255;
111 };
112
113 /* range structs */
114 static const struct comedi_lrange range_atmio16d_ai_10_bipolar = { 4, {
115                                                                        BIP_RANGE
116                                                                        (10),
117                                                                        BIP_RANGE
118                                                                        (1),
119                                                                        BIP_RANGE
120                                                                        (0.1),
121                                                                        BIP_RANGE
122                                                                        (0.02)
123                                                                        }
124 };
125
126 static const struct comedi_lrange range_atmio16d_ai_5_bipolar = { 4, {
127                                                                       BIP_RANGE
128                                                                       (5),
129                                                                       BIP_RANGE
130                                                                       (0.5),
131                                                                       BIP_RANGE
132                                                                       (0.05),
133                                                                       BIP_RANGE
134                                                                       (0.01)
135                                                                       }
136 };
137
138 static const struct comedi_lrange range_atmio16d_ai_unipolar = { 4, {
139                                                                      UNI_RANGE
140                                                                      (10),
141                                                                      UNI_RANGE
142                                                                      (1),
143                                                                      UNI_RANGE
144                                                                      (0.1),
145                                                                      UNI_RANGE
146                                                                      (0.02)
147                                                                      }
148 };
149
150 /* private data struct */
151 struct atmio16d_private {
152         enum { adc_diff, adc_singleended } adc_mux;
153         enum { adc_bipolar10, adc_bipolar5, adc_unipolar10 } adc_range;
154         enum { adc_2comp, adc_straight } adc_coding;
155         enum { dac_bipolar, dac_unipolar } dac0_range, dac1_range;
156         enum { dac_internal, dac_external } dac0_reference, dac1_reference;
157         enum { dac_2comp, dac_straight } dac0_coding, dac1_coding;
158         const struct comedi_lrange *ao_range_type_list[2];
159         unsigned int ao_readback[2];
160         unsigned int com_reg_1_state; /* current state of command register 1 */
161         unsigned int com_reg_2_state; /* current state of command register 2 */
162 };
163
164 static void reset_counters(struct comedi_device *dev)
165 {
166         /* Counter 2 */
167         outw(0xFFC2, dev->iobase + AM9513A_COM_REG);
168         outw(0xFF02, dev->iobase + AM9513A_COM_REG);
169         outw(0x4, dev->iobase + AM9513A_DATA_REG);
170         outw(0xFF0A, dev->iobase + AM9513A_COM_REG);
171         outw(0x3, dev->iobase + AM9513A_DATA_REG);
172         outw(0xFF42, dev->iobase + AM9513A_COM_REG);
173         outw(0xFF42, dev->iobase + AM9513A_COM_REG);
174         /* Counter 3 */
175         outw(0xFFC4, dev->iobase + AM9513A_COM_REG);
176         outw(0xFF03, dev->iobase + AM9513A_COM_REG);
177         outw(0x4, dev->iobase + AM9513A_DATA_REG);
178         outw(0xFF0B, dev->iobase + AM9513A_COM_REG);
179         outw(0x3, dev->iobase + AM9513A_DATA_REG);
180         outw(0xFF44, dev->iobase + AM9513A_COM_REG);
181         outw(0xFF44, dev->iobase + AM9513A_COM_REG);
182         /* Counter 4 */
183         outw(0xFFC8, dev->iobase + AM9513A_COM_REG);
184         outw(0xFF04, dev->iobase + AM9513A_COM_REG);
185         outw(0x4, dev->iobase + AM9513A_DATA_REG);
186         outw(0xFF0C, dev->iobase + AM9513A_COM_REG);
187         outw(0x3, dev->iobase + AM9513A_DATA_REG);
188         outw(0xFF48, dev->iobase + AM9513A_COM_REG);
189         outw(0xFF48, dev->iobase + AM9513A_COM_REG);
190         /* Counter 5 */
191         outw(0xFFD0, dev->iobase + AM9513A_COM_REG);
192         outw(0xFF05, dev->iobase + AM9513A_COM_REG);
193         outw(0x4, dev->iobase + AM9513A_DATA_REG);
194         outw(0xFF0D, dev->iobase + AM9513A_COM_REG);
195         outw(0x3, dev->iobase + AM9513A_DATA_REG);
196         outw(0xFF50, dev->iobase + AM9513A_COM_REG);
197         outw(0xFF50, dev->iobase + AM9513A_COM_REG);
198
199         outw(0, dev->iobase + AD_CLEAR_REG);
200 }
201
202 static void reset_atmio16d(struct comedi_device *dev)
203 {
204         struct atmio16d_private *devpriv = dev->private;
205         int i;
206
207         /* now we need to initialize the board */
208         outw(0, dev->iobase + COM_REG_1);
209         outw(0, dev->iobase + COM_REG_2);
210         outw(0, dev->iobase + MUX_GAIN_REG);
211         /* init AM9513A timer */
212         outw(0xFFFF, dev->iobase + AM9513A_COM_REG);
213         outw(0xFFEF, dev->iobase + AM9513A_COM_REG);
214         outw(0xFF17, dev->iobase + AM9513A_COM_REG);
215         outw(0xF000, dev->iobase + AM9513A_DATA_REG);
216         for (i = 1; i <= 5; ++i) {
217                 outw(0xFF00 + i, dev->iobase + AM9513A_COM_REG);
218                 outw(0x0004, dev->iobase + AM9513A_DATA_REG);
219                 outw(0xFF08 + i, dev->iobase + AM9513A_COM_REG);
220                 outw(0x3, dev->iobase + AM9513A_DATA_REG);
221         }
222         outw(0xFF5F, dev->iobase + AM9513A_COM_REG);
223         /* timer init done */
224         outw(0, dev->iobase + AD_CLEAR_REG);
225         outw(0, dev->iobase + INT2CLR_REG);
226         /* select straight binary mode for Analog Input */
227         devpriv->com_reg_1_state |= 1;
228         outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
229         devpriv->adc_coding = adc_straight;
230         /* zero the analog outputs */
231         outw(2048, dev->iobase + DAC0_REG);
232         outw(2048, dev->iobase + DAC1_REG);
233 }
234
235 static irqreturn_t atmio16d_interrupt(int irq, void *d)
236 {
237         struct comedi_device *dev = d;
238         struct comedi_subdevice *s = &dev->subdevices[0];
239
240         comedi_buf_put(s->async, inw(dev->iobase + AD_FIFO_REG));
241
242         comedi_event(dev, s);
243         return IRQ_HANDLED;
244 }
245
246 static int atmio16d_ai_cmdtest(struct comedi_device *dev,
247                                struct comedi_subdevice *s,
248                                struct comedi_cmd *cmd)
249 {
250         int err = 0;
251
252         /* Step 1 : check if triggers are trivially valid */
253
254         err |= cfc_check_trigger_src(&cmd->start_src, TRIG_NOW);
255         err |= cfc_check_trigger_src(&cmd->scan_begin_src,
256                                         TRIG_FOLLOW | TRIG_TIMER);
257         err |= cfc_check_trigger_src(&cmd->convert_src, TRIG_TIMER);
258         err |= cfc_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT);
259         err |= cfc_check_trigger_src(&cmd->stop_src, TRIG_COUNT | TRIG_NONE);
260
261         if (err)
262                 return 1;
263
264         /* Step 2a : make sure trigger sources are unique */
265
266         err |= cfc_check_trigger_is_unique(cmd->scan_begin_src);
267         err |= cfc_check_trigger_is_unique(cmd->stop_src);
268
269         /* Step 2b : and mutually compatible */
270
271         if (err)
272                 return 2;
273
274         /* step 3: make sure arguments are trivially compatible */
275
276         if (cmd->start_arg != 0) {
277                 cmd->start_arg = 0;
278                 err++;
279         }
280         if (cmd->scan_begin_src == TRIG_FOLLOW) {
281                 /* internal trigger */
282                 if (cmd->scan_begin_arg != 0) {
283                         cmd->scan_begin_arg = 0;
284                         err++;
285                 }
286         } else {
287 #if 0
288                 /* external trigger */
289                 /* should be level/edge, hi/lo specification here */
290                 if (cmd->scan_begin_arg != 0) {
291                         cmd->scan_begin_arg = 0;
292                         err++;
293                 }
294 #endif
295         }
296
297         if (cmd->convert_arg < 10000) {
298                 cmd->convert_arg = 10000;
299                 err++;
300         }
301 #if 0
302         if (cmd->convert_arg > SLOWEST_TIMER) {
303                 cmd->convert_arg = SLOWEST_TIMER;
304                 err++;
305         }
306 #endif
307         if (cmd->scan_end_arg != cmd->chanlist_len) {
308                 cmd->scan_end_arg = cmd->chanlist_len;
309                 err++;
310         }
311         if (cmd->stop_src == TRIG_COUNT) {
312                 /* any count is allowed */
313         } else {
314                 /* TRIG_NONE */
315                 if (cmd->stop_arg != 0) {
316                         cmd->stop_arg = 0;
317                         err++;
318                 }
319         }
320
321         if (err)
322                 return 3;
323
324         return 0;
325 }
326
327 static int atmio16d_ai_cmd(struct comedi_device *dev,
328                            struct comedi_subdevice *s)
329 {
330         struct atmio16d_private *devpriv = dev->private;
331         struct comedi_cmd *cmd = &s->async->cmd;
332         unsigned int timer, base_clock;
333         unsigned int sample_count, tmp, chan, gain;
334         int i;
335
336         /* This is slowly becoming a working command interface. *
337          * It is still uber-experimental */
338
339         reset_counters(dev);
340         s->async->cur_chan = 0;
341
342         /* check if scanning multiple channels */
343         if (cmd->chanlist_len < 2) {
344                 devpriv->com_reg_1_state &= ~COMREG1_SCANEN;
345                 outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
346         } else {
347                 devpriv->com_reg_1_state |= COMREG1_SCANEN;
348                 devpriv->com_reg_2_state |= COMREG2_SCN2;
349                 outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
350                 outw(devpriv->com_reg_2_state, dev->iobase + COM_REG_2);
351         }
352
353         /* Setup the Mux-Gain Counter */
354         for (i = 0; i < cmd->chanlist_len; ++i) {
355                 chan = CR_CHAN(cmd->chanlist[i]);
356                 gain = CR_RANGE(cmd->chanlist[i]);
357                 outw(i, dev->iobase + MUX_CNTR_REG);
358                 tmp = chan | (gain << 6);
359                 if (i == cmd->scan_end_arg - 1)
360                         tmp |= 0x0010;  /* set LASTONE bit */
361                 outw(tmp, dev->iobase + MUX_GAIN_REG);
362         }
363
364         /* Now program the sample interval timer */
365         /* Figure out which clock to use then get an
366          * appropriate timer value */
367         if (cmd->convert_arg < 65536000) {
368                 base_clock = CLOCK_1_MHZ;
369                 timer = cmd->convert_arg / 1000;
370         } else if (cmd->convert_arg < 655360000) {
371                 base_clock = CLOCK_100_KHZ;
372                 timer = cmd->convert_arg / 10000;
373         } else if (cmd->convert_arg <= 0xffffffff /* 6553600000 */) {
374                 base_clock = CLOCK_10_KHZ;
375                 timer = cmd->convert_arg / 100000;
376         } else if (cmd->convert_arg <= 0xffffffff /* 65536000000 */) {
377                 base_clock = CLOCK_1_KHZ;
378                 timer = cmd->convert_arg / 1000000;
379         }
380         outw(0xFF03, dev->iobase + AM9513A_COM_REG);
381         outw(base_clock, dev->iobase + AM9513A_DATA_REG);
382         outw(0xFF0B, dev->iobase + AM9513A_COM_REG);
383         outw(0x2, dev->iobase + AM9513A_DATA_REG);
384         outw(0xFF44, dev->iobase + AM9513A_COM_REG);
385         outw(0xFFF3, dev->iobase + AM9513A_COM_REG);
386         outw(timer, dev->iobase + AM9513A_DATA_REG);
387         outw(0xFF24, dev->iobase + AM9513A_COM_REG);
388
389         /* Now figure out how many samples to get */
390         /* and program the sample counter */
391         sample_count = cmd->stop_arg * cmd->scan_end_arg;
392         outw(0xFF04, dev->iobase + AM9513A_COM_REG);
393         outw(0x1025, dev->iobase + AM9513A_DATA_REG);
394         outw(0xFF0C, dev->iobase + AM9513A_COM_REG);
395         if (sample_count < 65536) {
396                 /* use only Counter 4 */
397                 outw(sample_count, dev->iobase + AM9513A_DATA_REG);
398                 outw(0xFF48, dev->iobase + AM9513A_COM_REG);
399                 outw(0xFFF4, dev->iobase + AM9513A_COM_REG);
400                 outw(0xFF28, dev->iobase + AM9513A_COM_REG);
401                 devpriv->com_reg_1_state &= ~COMREG1_1632CNT;
402                 outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
403         } else {
404                 /* Counter 4 and 5 are needed */
405
406                 tmp = sample_count & 0xFFFF;
407                 if (tmp)
408                         outw(tmp - 1, dev->iobase + AM9513A_DATA_REG);
409                 else
410                         outw(0xFFFF, dev->iobase + AM9513A_DATA_REG);
411
412                 outw(0xFF48, dev->iobase + AM9513A_COM_REG);
413                 outw(0, dev->iobase + AM9513A_DATA_REG);
414                 outw(0xFF28, dev->iobase + AM9513A_COM_REG);
415                 outw(0xFF05, dev->iobase + AM9513A_COM_REG);
416                 outw(0x25, dev->iobase + AM9513A_DATA_REG);
417                 outw(0xFF0D, dev->iobase + AM9513A_COM_REG);
418                 tmp = sample_count & 0xFFFF;
419                 if ((tmp == 0) || (tmp == 1)) {
420                         outw((sample_count >> 16) & 0xFFFF,
421                              dev->iobase + AM9513A_DATA_REG);
422                 } else {
423                         outw(((sample_count >> 16) & 0xFFFF) + 1,
424                              dev->iobase + AM9513A_DATA_REG);
425                 }
426                 outw(0xFF70, dev->iobase + AM9513A_COM_REG);
427                 devpriv->com_reg_1_state |= COMREG1_1632CNT;
428                 outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
429         }
430
431         /* Program the scan interval timer ONLY IF SCANNING IS ENABLED */
432         /* Figure out which clock to use then get an
433          * appropriate timer value */
434         if (cmd->chanlist_len > 1) {
435                 if (cmd->scan_begin_arg < 65536000) {
436                         base_clock = CLOCK_1_MHZ;
437                         timer = cmd->scan_begin_arg / 1000;
438                 } else if (cmd->scan_begin_arg < 655360000) {
439                         base_clock = CLOCK_100_KHZ;
440                         timer = cmd->scan_begin_arg / 10000;
441                 } else if (cmd->scan_begin_arg < 0xffffffff /* 6553600000 */) {
442                         base_clock = CLOCK_10_KHZ;
443                         timer = cmd->scan_begin_arg / 100000;
444                 } else if (cmd->scan_begin_arg < 0xffffffff /* 65536000000 */) {
445                         base_clock = CLOCK_1_KHZ;
446                         timer = cmd->scan_begin_arg / 1000000;
447                 }
448                 outw(0xFF02, dev->iobase + AM9513A_COM_REG);
449                 outw(base_clock, dev->iobase + AM9513A_DATA_REG);
450                 outw(0xFF0A, dev->iobase + AM9513A_COM_REG);
451                 outw(0x2, dev->iobase + AM9513A_DATA_REG);
452                 outw(0xFF42, dev->iobase + AM9513A_COM_REG);
453                 outw(0xFFF2, dev->iobase + AM9513A_COM_REG);
454                 outw(timer, dev->iobase + AM9513A_DATA_REG);
455                 outw(0xFF22, dev->iobase + AM9513A_COM_REG);
456         }
457
458         /* Clear the A/D FIFO and reset the MUX counter */
459         outw(0, dev->iobase + AD_CLEAR_REG);
460         outw(0, dev->iobase + MUX_CNTR_REG);
461         outw(0, dev->iobase + INT2CLR_REG);
462         /* enable this acquisition operation */
463         devpriv->com_reg_1_state |= COMREG1_DAQEN;
464         outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
465         /* enable interrupts for conversion completion */
466         devpriv->com_reg_1_state |= COMREG1_CONVINTEN;
467         devpriv->com_reg_2_state |= COMREG2_INTEN;
468         outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
469         outw(devpriv->com_reg_2_state, dev->iobase + COM_REG_2);
470         /* apply a trigger. this starts the counters! */
471         outw(0, dev->iobase + START_DAQ_REG);
472
473         return 0;
474 }
475
476 /* This will cancel a running acquisition operation */
477 static int atmio16d_ai_cancel(struct comedi_device *dev,
478                               struct comedi_subdevice *s)
479 {
480         reset_atmio16d(dev);
481
482         return 0;
483 }
484
485 /* Mode 0 is used to get a single conversion on demand */
486 static int atmio16d_ai_insn_read(struct comedi_device *dev,
487                                  struct comedi_subdevice *s,
488                                  struct comedi_insn *insn, unsigned int *data)
489 {
490         struct atmio16d_private *devpriv = dev->private;
491         int i, t;
492         int chan;
493         int gain;
494         int status;
495
496         chan = CR_CHAN(insn->chanspec);
497         gain = CR_RANGE(insn->chanspec);
498
499         /* reset the Analog input circuitry */
500         /* outw( 0, dev->iobase+AD_CLEAR_REG ); */
501         /* reset the Analog Input MUX Counter to 0 */
502         /* outw( 0, dev->iobase+MUX_CNTR_REG ); */
503
504         /* set the Input MUX gain */
505         outw(chan | (gain << 6), dev->iobase + MUX_GAIN_REG);
506
507         for (i = 0; i < insn->n; i++) {
508                 /* start the conversion */
509                 outw(0, dev->iobase + START_CONVERT_REG);
510                 /* wait for it to finish */
511                 for (t = 0; t < ATMIO16D_TIMEOUT; t++) {
512                         /* check conversion status */
513                         status = inw(dev->iobase + STAT_REG);
514                         if (status & STAT_AD_CONVAVAIL) {
515                                 /* read the data now */
516                                 data[i] = inw(dev->iobase + AD_FIFO_REG);
517                                 /* change to two's complement if need be */
518                                 if (devpriv->adc_coding == adc_2comp)
519                                         data[i] ^= 0x800;
520                                 break;
521                         }
522                         if (status & STAT_AD_OVERFLOW) {
523                                 printk(KERN_INFO "atmio16d: a/d FIFO overflow\n");
524                                 outw(0, dev->iobase + AD_CLEAR_REG);
525
526                                 return -ETIME;
527                         }
528                 }
529                 /* end waiting, now check if it timed out */
530                 if (t == ATMIO16D_TIMEOUT) {
531                         printk(KERN_INFO "atmio16d: timeout\n");
532
533                         return -ETIME;
534                 }
535         }
536
537         return i;
538 }
539
540 static int atmio16d_ao_insn_read(struct comedi_device *dev,
541                                  struct comedi_subdevice *s,
542                                  struct comedi_insn *insn, unsigned int *data)
543 {
544         struct atmio16d_private *devpriv = dev->private;
545         int i;
546
547         for (i = 0; i < insn->n; i++)
548                 data[i] = devpriv->ao_readback[CR_CHAN(insn->chanspec)];
549         return i;
550 }
551
552 static int atmio16d_ao_insn_write(struct comedi_device *dev,
553                                   struct comedi_subdevice *s,
554                                   struct comedi_insn *insn, unsigned int *data)
555 {
556         struct atmio16d_private *devpriv = dev->private;
557         int i;
558         int chan;
559         int d;
560
561         chan = CR_CHAN(insn->chanspec);
562
563         for (i = 0; i < insn->n; i++) {
564                 d = data[i];
565                 switch (chan) {
566                 case 0:
567                         if (devpriv->dac0_coding == dac_2comp)
568                                 d ^= 0x800;
569                         outw(d, dev->iobase + DAC0_REG);
570                         break;
571                 case 1:
572                         if (devpriv->dac1_coding == dac_2comp)
573                                 d ^= 0x800;
574                         outw(d, dev->iobase + DAC1_REG);
575                         break;
576                 default:
577                         return -EINVAL;
578                 }
579                 devpriv->ao_readback[chan] = data[i];
580         }
581         return i;
582 }
583
584 static int atmio16d_dio_insn_bits(struct comedi_device *dev,
585                                   struct comedi_subdevice *s,
586                                   struct comedi_insn *insn, unsigned int *data)
587 {
588         if (data[0]) {
589                 s->state &= ~data[0];
590                 s->state |= (data[0] | data[1]);
591                 outw(s->state, dev->iobase + MIO_16_DIG_OUT_REG);
592         }
593         data[1] = inw(dev->iobase + MIO_16_DIG_IN_REG);
594
595         return insn->n;
596 }
597
598 static int atmio16d_dio_insn_config(struct comedi_device *dev,
599                                     struct comedi_subdevice *s,
600                                     struct comedi_insn *insn,
601                                     unsigned int *data)
602 {
603         struct atmio16d_private *devpriv = dev->private;
604         int i;
605         int mask;
606
607         for (i = 0; i < insn->n; i++) {
608                 mask = (CR_CHAN(insn->chanspec) < 4) ? 0x0f : 0xf0;
609                 s->io_bits &= ~mask;
610                 if (data[i])
611                         s->io_bits |= mask;
612         }
613         devpriv->com_reg_2_state &= ~(COMREG2_DOUTEN0 | COMREG2_DOUTEN1);
614         if (s->io_bits & 0x0f)
615                 devpriv->com_reg_2_state |= COMREG2_DOUTEN0;
616         if (s->io_bits & 0xf0)
617                 devpriv->com_reg_2_state |= COMREG2_DOUTEN1;
618         outw(devpriv->com_reg_2_state, dev->iobase + COM_REG_2);
619
620         return i;
621 }
622
623 /*
624    options[0] - I/O port
625    options[1] - MIO irq
626                 0 == no irq
627                 N == irq N {3,4,5,6,7,9,10,11,12,14,15}
628    options[2] - DIO irq
629                 0 == no irq
630                 N == irq N {3,4,5,6,7,9}
631    options[3] - DMA1 channel
632                 0 == no DMA
633                 N == DMA N {5,6,7}
634    options[4] - DMA2 channel
635                 0 == no DMA
636                 N == DMA N {5,6,7}
637
638    options[5] - a/d mux
639         0=differential, 1=single
640    options[6] - a/d range
641         0=bipolar10, 1=bipolar5, 2=unipolar10
642
643    options[7] - dac0 range
644         0=bipolar, 1=unipolar
645    options[8] - dac0 reference
646         0=internal, 1=external
647    options[9] - dac0 coding
648         0=2's comp, 1=straight binary
649
650    options[10] - dac1 range
651    options[11] - dac1 reference
652    options[12] - dac1 coding
653  */
654
655 static int atmio16d_attach(struct comedi_device *dev,
656                            struct comedi_devconfig *it)
657 {
658         const struct atmio16_board_t *board = comedi_board(dev);
659         struct atmio16d_private *devpriv;
660         unsigned int irq;
661         unsigned long iobase;
662         int ret;
663
664         struct comedi_subdevice *s;
665
666         /* make sure the address range is free and allocate it */
667         iobase = it->options[0];
668         printk(KERN_INFO "comedi%d: atmio16d: 0x%04lx ", dev->minor, iobase);
669         if (!request_region(iobase, ATMIO16D_SIZE, "ni_atmio16d")) {
670                 printk("I/O port conflict\n");
671                 return -EIO;
672         }
673         dev->iobase = iobase;
674
675         dev->board_name = board->name;
676
677         ret = comedi_alloc_subdevices(dev, 4);
678         if (ret)
679                 return ret;
680
681         devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
682         if (!devpriv)
683                 return -ENOMEM;
684         dev->private = devpriv;
685
686         /* reset the atmio16d hardware */
687         reset_atmio16d(dev);
688
689         /* check if our interrupt is available and get it */
690         irq = it->options[1];
691         if (irq) {
692
693                 ret = request_irq(irq, atmio16d_interrupt, 0, "atmio16d", dev);
694                 if (ret < 0) {
695                         printk(KERN_INFO "failed to allocate irq %u\n", irq);
696                         return ret;
697                 }
698                 dev->irq = irq;
699                 printk(KERN_INFO "( irq = %u )\n", irq);
700         } else {
701                 printk(KERN_INFO "( no irq )");
702         }
703
704         /* set device options */
705         devpriv->adc_mux = it->options[5];
706         devpriv->adc_range = it->options[6];
707
708         devpriv->dac0_range = it->options[7];
709         devpriv->dac0_reference = it->options[8];
710         devpriv->dac0_coding = it->options[9];
711         devpriv->dac1_range = it->options[10];
712         devpriv->dac1_reference = it->options[11];
713         devpriv->dac1_coding = it->options[12];
714
715         /* setup sub-devices */
716         s = &dev->subdevices[0];
717         dev->read_subdev = s;
718         /* ai subdevice */
719         s->type = COMEDI_SUBD_AI;
720         s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_CMD_READ;
721         s->n_chan = (devpriv->adc_mux ? 16 : 8);
722         s->len_chanlist = 16;
723         s->insn_read = atmio16d_ai_insn_read;
724         s->do_cmdtest = atmio16d_ai_cmdtest;
725         s->do_cmd = atmio16d_ai_cmd;
726         s->cancel = atmio16d_ai_cancel;
727         s->maxdata = 0xfff;     /* 4095 decimal */
728         switch (devpriv->adc_range) {
729         case adc_bipolar10:
730                 s->range_table = &range_atmio16d_ai_10_bipolar;
731                 break;
732         case adc_bipolar5:
733                 s->range_table = &range_atmio16d_ai_5_bipolar;
734                 break;
735         case adc_unipolar10:
736                 s->range_table = &range_atmio16d_ai_unipolar;
737                 break;
738         }
739
740         /* ao subdevice */
741         s = &dev->subdevices[1];
742         s->type = COMEDI_SUBD_AO;
743         s->subdev_flags = SDF_WRITABLE;
744         s->n_chan = 2;
745         s->insn_read = atmio16d_ao_insn_read;
746         s->insn_write = atmio16d_ao_insn_write;
747         s->maxdata = 0xfff;     /* 4095 decimal */
748         s->range_table_list = devpriv->ao_range_type_list;
749         switch (devpriv->dac0_range) {
750         case dac_bipolar:
751                 devpriv->ao_range_type_list[0] = &range_bipolar10;
752                 break;
753         case dac_unipolar:
754                 devpriv->ao_range_type_list[0] = &range_unipolar10;
755                 break;
756         }
757         switch (devpriv->dac1_range) {
758         case dac_bipolar:
759                 devpriv->ao_range_type_list[1] = &range_bipolar10;
760                 break;
761         case dac_unipolar:
762                 devpriv->ao_range_type_list[1] = &range_unipolar10;
763                 break;
764         }
765
766         /* Digital I/O */
767         s = &dev->subdevices[2];
768         s->type = COMEDI_SUBD_DIO;
769         s->subdev_flags = SDF_WRITABLE | SDF_READABLE;
770         s->n_chan = 8;
771         s->insn_bits = atmio16d_dio_insn_bits;
772         s->insn_config = atmio16d_dio_insn_config;
773         s->maxdata = 1;
774         s->range_table = &range_digital;
775
776         /* 8255 subdevice */
777         s = &dev->subdevices[3];
778         if (board->has_8255)
779                 subdev_8255_init(dev, s, NULL, dev->iobase);
780         else
781                 s->type = COMEDI_SUBD_UNUSED;
782
783 /* don't yet know how to deal with counter/timers */
784 #if 0
785         s = &dev->subdevices[4];
786         /* do */
787         s->type = COMEDI_SUBD_TIMER;
788         s->n_chan = 0;
789         s->maxdata = 0
790 #endif
791             printk("\n");
792
793         return 0;
794 }
795
796 static void atmio16d_detach(struct comedi_device *dev)
797 {
798         const struct atmio16_board_t *board = comedi_board(dev);
799         struct comedi_subdevice *s;
800
801         if (dev->subdevices && board->has_8255) {
802                 s = &dev->subdevices[3];
803                 subdev_8255_cleanup(dev, s);
804         }
805         if (dev->irq)
806                 free_irq(dev->irq, dev);
807         reset_atmio16d(dev);
808         if (dev->iobase)
809                 release_region(dev->iobase, ATMIO16D_SIZE);
810 }
811
812 static const struct atmio16_board_t atmio16_boards[] = {
813         {
814                 .name           = "atmio16",
815                 .has_8255       = 0,
816         }, {
817                 .name           = "atmio16d",
818                 .has_8255       = 1,
819         },
820 };
821
822 static struct comedi_driver atmio16d_driver = {
823         .driver_name    = "atmio16",
824         .module         = THIS_MODULE,
825         .attach         = atmio16d_attach,
826         .detach         = atmio16d_detach,
827         .board_name     = &atmio16_boards[0].name,
828         .num_names      = ARRAY_SIZE(atmio16_boards),
829         .offset         = sizeof(struct atmio16_board_t),
830 };
831 module_comedi_driver(atmio16d_driver);
832
833 MODULE_AUTHOR("Comedi http://www.comedi.org");
834 MODULE_DESCRIPTION("Comedi low-level driver");
835 MODULE_LICENSE("GPL");