1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Comedi driver for National Instruments AT-MIO16D board
4  * Copyright (C) 2000 Chris R. Baugher <baugher@enteract.com>
5  */
6 
7 /*
8  * Driver: ni_atmio16d
9  * Description: National Instruments AT-MIO-16D
10  * Author: Chris R. Baugher <baugher@enteract.com>
11  * Status: unknown
12  * Devices: [National Instruments] AT-MIO-16 (atmio16), AT-MIO-16D (atmio16d)
13  *
14  * Configuration options:
15  *   [0] - I/O port
16  *   [1] - MIO irq (0 == no irq; or 3,4,5,6,7,9,10,11,12,14,15)
17  *   [2] - DIO irq (0 == no irq; or 3,4,5,6,7,9)
18  *   [3] - DMA1 channel (0 == no DMA; or 5,6,7)
19  *   [4] - DMA2 channel (0 == no DMA; or 5,6,7)
20  *   [5] - a/d mux (0=differential; 1=single)
21  *   [6] - a/d range (0=bipolar10; 1=bipolar5; 2=unipolar10)
22  *   [7] - dac0 range (0=bipolar; 1=unipolar)
23  *   [8] - dac0 reference (0=internal; 1=external)
24  *   [9] - dac0 coding (0=2's comp; 1=straight binary)
25  *   [10] - dac1 range (same as dac0 options)
26  *   [11] - dac1 reference (same as dac0 options)
27  *   [12] - dac1 coding (same as dac0 options)
28  */
29 
30 /*
31  * I must give credit here to Michal Dobes <dobes@tesnet.cz> who
32  * wrote the driver for Advantec's pcl812 boards. I used the interrupt
33  * handling code from his driver as an example for this one.
34  *
35  * Chris Baugher
36  * 5/1/2000
37  *
38  */
39 
40 #include <linux/module.h>
41 #include <linux/interrupt.h>
42 #include "../comedidev.h"
43 
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 
104 struct atmio16_board_t {
105 	const char *name;
106 	int has_8255;
107 };
108 
109 /* range structs */
110 static const struct comedi_lrange range_atmio16d_ai_10_bipolar = {
111 	4, {
112 		BIP_RANGE(10),
113 		BIP_RANGE(1),
114 		BIP_RANGE(0.1),
115 		BIP_RANGE(0.02)
116 	}
117 };
118 
119 static const struct comedi_lrange range_atmio16d_ai_5_bipolar = {
120 	4, {
121 		BIP_RANGE(5),
122 		BIP_RANGE(0.5),
123 		BIP_RANGE(0.05),
124 		BIP_RANGE(0.01)
125 	}
126 };
127 
128 static const struct comedi_lrange range_atmio16d_ai_unipolar = {
129 	4, {
130 		UNI_RANGE(10),
131 		UNI_RANGE(1),
132 		UNI_RANGE(0.1),
133 		UNI_RANGE(0.02)
134 	}
135 };
136 
137 /* private data struct */
138 struct atmio16d_private {
139 	enum { adc_diff, adc_singleended } adc_mux;
140 	enum { adc_bipolar10, adc_bipolar5, adc_unipolar10 } adc_range;
141 	enum { adc_2comp, adc_straight } adc_coding;
142 	enum { dac_bipolar, dac_unipolar } dac0_range, dac1_range;
143 	enum { dac_internal, dac_external } dac0_reference, dac1_reference;
144 	enum { dac_2comp, dac_straight } dac0_coding, dac1_coding;
145 	const struct comedi_lrange *ao_range_type_list[2];
146 	unsigned int com_reg_1_state; /* current state of command register 1 */
147 	unsigned int com_reg_2_state; /* current state of command register 2 */
148 };
149 
reset_counters(struct comedi_device * dev)150 static void reset_counters(struct comedi_device *dev)
151 {
152 	/* Counter 2 */
153 	outw(0xFFC2, dev->iobase + AM9513A_COM_REG);
154 	outw(0xFF02, dev->iobase + AM9513A_COM_REG);
155 	outw(0x4, dev->iobase + AM9513A_DATA_REG);
156 	outw(0xFF0A, dev->iobase + AM9513A_COM_REG);
157 	outw(0x3, dev->iobase + AM9513A_DATA_REG);
158 	outw(0xFF42, dev->iobase + AM9513A_COM_REG);
159 	outw(0xFF42, dev->iobase + AM9513A_COM_REG);
160 	/* Counter 3 */
161 	outw(0xFFC4, dev->iobase + AM9513A_COM_REG);
162 	outw(0xFF03, dev->iobase + AM9513A_COM_REG);
163 	outw(0x4, dev->iobase + AM9513A_DATA_REG);
164 	outw(0xFF0B, dev->iobase + AM9513A_COM_REG);
165 	outw(0x3, dev->iobase + AM9513A_DATA_REG);
166 	outw(0xFF44, dev->iobase + AM9513A_COM_REG);
167 	outw(0xFF44, dev->iobase + AM9513A_COM_REG);
168 	/* Counter 4 */
169 	outw(0xFFC8, dev->iobase + AM9513A_COM_REG);
170 	outw(0xFF04, dev->iobase + AM9513A_COM_REG);
171 	outw(0x4, dev->iobase + AM9513A_DATA_REG);
172 	outw(0xFF0C, dev->iobase + AM9513A_COM_REG);
173 	outw(0x3, dev->iobase + AM9513A_DATA_REG);
174 	outw(0xFF48, dev->iobase + AM9513A_COM_REG);
175 	outw(0xFF48, dev->iobase + AM9513A_COM_REG);
176 	/* Counter 5 */
177 	outw(0xFFD0, dev->iobase + AM9513A_COM_REG);
178 	outw(0xFF05, dev->iobase + AM9513A_COM_REG);
179 	outw(0x4, dev->iobase + AM9513A_DATA_REG);
180 	outw(0xFF0D, dev->iobase + AM9513A_COM_REG);
181 	outw(0x3, dev->iobase + AM9513A_DATA_REG);
182 	outw(0xFF50, dev->iobase + AM9513A_COM_REG);
183 	outw(0xFF50, dev->iobase + AM9513A_COM_REG);
184 
185 	outw(0, dev->iobase + AD_CLEAR_REG);
186 }
187 
reset_atmio16d(struct comedi_device * dev)188 static void reset_atmio16d(struct comedi_device *dev)
189 {
190 	struct atmio16d_private *devpriv = dev->private;
191 	int i;
192 
193 	/* now we need to initialize the board */
194 	outw(0, dev->iobase + COM_REG_1);
195 	outw(0, dev->iobase + COM_REG_2);
196 	outw(0, dev->iobase + MUX_GAIN_REG);
197 	/* init AM9513A timer */
198 	outw(0xFFFF, dev->iobase + AM9513A_COM_REG);
199 	outw(0xFFEF, dev->iobase + AM9513A_COM_REG);
200 	outw(0xFF17, dev->iobase + AM9513A_COM_REG);
201 	outw(0xF000, dev->iobase + AM9513A_DATA_REG);
202 	for (i = 1; i <= 5; ++i) {
203 		outw(0xFF00 + i, dev->iobase + AM9513A_COM_REG);
204 		outw(0x0004, dev->iobase + AM9513A_DATA_REG);
205 		outw(0xFF08 + i, dev->iobase + AM9513A_COM_REG);
206 		outw(0x3, dev->iobase + AM9513A_DATA_REG);
207 	}
208 	outw(0xFF5F, dev->iobase + AM9513A_COM_REG);
209 	/* timer init done */
210 	outw(0, dev->iobase + AD_CLEAR_REG);
211 	outw(0, dev->iobase + INT2CLR_REG);
212 	/* select straight binary mode for Analog Input */
213 	devpriv->com_reg_1_state |= 1;
214 	outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
215 	devpriv->adc_coding = adc_straight;
216 	/* zero the analog outputs */
217 	outw(2048, dev->iobase + DAC0_REG);
218 	outw(2048, dev->iobase + DAC1_REG);
219 }
220 
atmio16d_interrupt(int irq,void * d)221 static irqreturn_t atmio16d_interrupt(int irq, void *d)
222 {
223 	struct comedi_device *dev = d;
224 	struct comedi_subdevice *s = dev->read_subdev;
225 	unsigned short val;
226 
227 	val = inw(dev->iobase + AD_FIFO_REG);
228 	comedi_buf_write_samples(s, &val, 1);
229 	comedi_handle_events(dev, s);
230 
231 	return IRQ_HANDLED;
232 }
233 
atmio16d_ai_cmdtest(struct comedi_device * dev,struct comedi_subdevice * s,struct comedi_cmd * cmd)234 static int atmio16d_ai_cmdtest(struct comedi_device *dev,
235 			       struct comedi_subdevice *s,
236 			       struct comedi_cmd *cmd)
237 {
238 	int err = 0;
239 
240 	/* Step 1 : check if triggers are trivially valid */
241 
242 	err |= comedi_check_trigger_src(&cmd->start_src, TRIG_NOW);
243 	err |= comedi_check_trigger_src(&cmd->scan_begin_src,
244 					TRIG_FOLLOW | TRIG_TIMER);
245 	err |= comedi_check_trigger_src(&cmd->convert_src, TRIG_TIMER);
246 	err |= comedi_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT);
247 	err |= comedi_check_trigger_src(&cmd->stop_src, TRIG_COUNT | TRIG_NONE);
248 
249 	if (err)
250 		return 1;
251 
252 	/* Step 2a : make sure trigger sources are unique */
253 
254 	err |= comedi_check_trigger_is_unique(cmd->scan_begin_src);
255 	err |= comedi_check_trigger_is_unique(cmd->stop_src);
256 
257 	/* Step 2b : and mutually compatible */
258 
259 	if (err)
260 		return 2;
261 
262 	/* Step 3: check if arguments are trivially valid */
263 
264 	err |= comedi_check_trigger_arg_is(&cmd->start_arg, 0);
265 
266 	if (cmd->scan_begin_src == TRIG_FOLLOW) {
267 		/* internal trigger */
268 		err |= comedi_check_trigger_arg_is(&cmd->scan_begin_arg, 0);
269 	} else {
270 #if 0
271 		/* external trigger */
272 		/* should be level/edge, hi/lo specification here */
273 		err |= comedi_check_trigger_arg_is(&cmd->scan_begin_arg, 0);
274 #endif
275 	}
276 
277 	err |= comedi_check_trigger_arg_min(&cmd->convert_arg, 10000);
278 #if 0
279 	err |= comedi_check_trigger_arg_max(&cmd->convert_arg, SLOWEST_TIMER);
280 #endif
281 
282 	err |= comedi_check_trigger_arg_is(&cmd->scan_end_arg,
283 					   cmd->chanlist_len);
284 
285 	if (cmd->stop_src == TRIG_COUNT)
286 		err |= comedi_check_trigger_arg_min(&cmd->stop_arg, 1);
287 	else	/* TRIG_NONE */
288 		err |= comedi_check_trigger_arg_is(&cmd->stop_arg, 0);
289 
290 	if (err)
291 		return 3;
292 
293 	return 0;
294 }
295 
atmio16d_ai_cmd(struct comedi_device * dev,struct comedi_subdevice * s)296 static int atmio16d_ai_cmd(struct comedi_device *dev,
297 			   struct comedi_subdevice *s)
298 {
299 	struct atmio16d_private *devpriv = dev->private;
300 	struct comedi_cmd *cmd = &s->async->cmd;
301 	unsigned int timer, base_clock;
302 	unsigned int sample_count, tmp, chan, gain;
303 	int i;
304 
305 	/*
306 	 * This is slowly becoming a working command interface.
307 	 * It is still uber-experimental
308 	 */
309 
310 	reset_counters(dev);
311 
312 	/* check if scanning multiple channels */
313 	if (cmd->chanlist_len < 2) {
314 		devpriv->com_reg_1_state &= ~COMREG1_SCANEN;
315 		outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
316 	} else {
317 		devpriv->com_reg_1_state |= COMREG1_SCANEN;
318 		devpriv->com_reg_2_state |= COMREG2_SCN2;
319 		outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
320 		outw(devpriv->com_reg_2_state, dev->iobase + COM_REG_2);
321 	}
322 
323 	/* Setup the Mux-Gain Counter */
324 	for (i = 0; i < cmd->chanlist_len; ++i) {
325 		chan = CR_CHAN(cmd->chanlist[i]);
326 		gain = CR_RANGE(cmd->chanlist[i]);
327 		outw(i, dev->iobase + MUX_CNTR_REG);
328 		tmp = chan | (gain << 6);
329 		if (i == cmd->scan_end_arg - 1)
330 			tmp |= 0x0010;	/* set LASTONE bit */
331 		outw(tmp, dev->iobase + MUX_GAIN_REG);
332 	}
333 
334 	/*
335 	 * Now program the sample interval timer.
336 	 * Figure out which clock to use then get an appropriate timer value.
337 	 */
338 	if (cmd->convert_arg < 65536000) {
339 		base_clock = CLOCK_1_MHZ;
340 		timer = cmd->convert_arg / 1000;
341 	} else if (cmd->convert_arg < 655360000) {
342 		base_clock = CLOCK_100_KHZ;
343 		timer = cmd->convert_arg / 10000;
344 	} else /* cmd->convert_arg < 6553600000 */ {
345 		base_clock = CLOCK_10_KHZ;
346 		timer = cmd->convert_arg / 100000;
347 	}
348 	outw(0xFF03, dev->iobase + AM9513A_COM_REG);
349 	outw(base_clock, dev->iobase + AM9513A_DATA_REG);
350 	outw(0xFF0B, dev->iobase + AM9513A_COM_REG);
351 	outw(0x2, dev->iobase + AM9513A_DATA_REG);
352 	outw(0xFF44, dev->iobase + AM9513A_COM_REG);
353 	outw(0xFFF3, dev->iobase + AM9513A_COM_REG);
354 	outw(timer, dev->iobase + AM9513A_DATA_REG);
355 	outw(0xFF24, dev->iobase + AM9513A_COM_REG);
356 
357 	/* Now figure out how many samples to get */
358 	/* and program the sample counter */
359 	sample_count = cmd->stop_arg * cmd->scan_end_arg;
360 	outw(0xFF04, dev->iobase + AM9513A_COM_REG);
361 	outw(0x1025, dev->iobase + AM9513A_DATA_REG);
362 	outw(0xFF0C, dev->iobase + AM9513A_COM_REG);
363 	if (sample_count < 65536) {
364 		/* use only Counter 4 */
365 		outw(sample_count, dev->iobase + AM9513A_DATA_REG);
366 		outw(0xFF48, dev->iobase + AM9513A_COM_REG);
367 		outw(0xFFF4, dev->iobase + AM9513A_COM_REG);
368 		outw(0xFF28, dev->iobase + AM9513A_COM_REG);
369 		devpriv->com_reg_1_state &= ~COMREG1_1632CNT;
370 		outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
371 	} else {
372 		/* Counter 4 and 5 are needed */
373 
374 		tmp = sample_count & 0xFFFF;
375 		if (tmp)
376 			outw(tmp - 1, dev->iobase + AM9513A_DATA_REG);
377 		else
378 			outw(0xFFFF, dev->iobase + AM9513A_DATA_REG);
379 
380 		outw(0xFF48, dev->iobase + AM9513A_COM_REG);
381 		outw(0, dev->iobase + AM9513A_DATA_REG);
382 		outw(0xFF28, dev->iobase + AM9513A_COM_REG);
383 		outw(0xFF05, dev->iobase + AM9513A_COM_REG);
384 		outw(0x25, dev->iobase + AM9513A_DATA_REG);
385 		outw(0xFF0D, dev->iobase + AM9513A_COM_REG);
386 		tmp = sample_count & 0xFFFF;
387 		if ((tmp == 0) || (tmp == 1)) {
388 			outw((sample_count >> 16) & 0xFFFF,
389 			     dev->iobase + AM9513A_DATA_REG);
390 		} else {
391 			outw(((sample_count >> 16) & 0xFFFF) + 1,
392 			     dev->iobase + AM9513A_DATA_REG);
393 		}
394 		outw(0xFF70, dev->iobase + AM9513A_COM_REG);
395 		devpriv->com_reg_1_state |= COMREG1_1632CNT;
396 		outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
397 	}
398 
399 	/*
400 	 * Program the scan interval timer ONLY IF SCANNING IS ENABLED.
401 	 * Figure out which clock to use then get an appropriate timer value.
402 	 */
403 	if (cmd->chanlist_len > 1) {
404 		if (cmd->scan_begin_arg < 65536000) {
405 			base_clock = CLOCK_1_MHZ;
406 			timer = cmd->scan_begin_arg / 1000;
407 		} else if (cmd->scan_begin_arg < 655360000) {
408 			base_clock = CLOCK_100_KHZ;
409 			timer = cmd->scan_begin_arg / 10000;
410 		} else /* cmd->scan_begin_arg < 6553600000 */ {
411 			base_clock = CLOCK_10_KHZ;
412 			timer = cmd->scan_begin_arg / 100000;
413 		}
414 		outw(0xFF02, dev->iobase + AM9513A_COM_REG);
415 		outw(base_clock, dev->iobase + AM9513A_DATA_REG);
416 		outw(0xFF0A, dev->iobase + AM9513A_COM_REG);
417 		outw(0x2, dev->iobase + AM9513A_DATA_REG);
418 		outw(0xFF42, dev->iobase + AM9513A_COM_REG);
419 		outw(0xFFF2, dev->iobase + AM9513A_COM_REG);
420 		outw(timer, dev->iobase + AM9513A_DATA_REG);
421 		outw(0xFF22, dev->iobase + AM9513A_COM_REG);
422 	}
423 
424 	/* Clear the A/D FIFO and reset the MUX counter */
425 	outw(0, dev->iobase + AD_CLEAR_REG);
426 	outw(0, dev->iobase + MUX_CNTR_REG);
427 	outw(0, dev->iobase + INT2CLR_REG);
428 	/* enable this acquisition operation */
429 	devpriv->com_reg_1_state |= COMREG1_DAQEN;
430 	outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
431 	/* enable interrupts for conversion completion */
432 	devpriv->com_reg_1_state |= COMREG1_CONVINTEN;
433 	devpriv->com_reg_2_state |= COMREG2_INTEN;
434 	outw(devpriv->com_reg_1_state, dev->iobase + COM_REG_1);
435 	outw(devpriv->com_reg_2_state, dev->iobase + COM_REG_2);
436 	/* apply a trigger. this starts the counters! */
437 	outw(0, dev->iobase + START_DAQ_REG);
438 
439 	return 0;
440 }
441 
442 /* This will cancel a running acquisition operation */
atmio16d_ai_cancel(struct comedi_device * dev,struct comedi_subdevice * s)443 static int atmio16d_ai_cancel(struct comedi_device *dev,
444 			      struct comedi_subdevice *s)
445 {
446 	reset_atmio16d(dev);
447 
448 	return 0;
449 }
450 
atmio16d_ai_eoc(struct comedi_device * dev,struct comedi_subdevice * s,struct comedi_insn * insn,unsigned long context)451 static int atmio16d_ai_eoc(struct comedi_device *dev,
452 			   struct comedi_subdevice *s,
453 			   struct comedi_insn *insn,
454 			   unsigned long context)
455 {
456 	unsigned int status;
457 
458 	status = inw(dev->iobase + STAT_REG);
459 	if (status & STAT_AD_CONVAVAIL)
460 		return 0;
461 	if (status & STAT_AD_OVERFLOW) {
462 		outw(0, dev->iobase + AD_CLEAR_REG);
463 		return -EOVERFLOW;
464 	}
465 	return -EBUSY;
466 }
467 
atmio16d_ai_insn_read(struct comedi_device * dev,struct comedi_subdevice * s,struct comedi_insn * insn,unsigned int * data)468 static int atmio16d_ai_insn_read(struct comedi_device *dev,
469 				 struct comedi_subdevice *s,
470 				 struct comedi_insn *insn, unsigned int *data)
471 {
472 	struct atmio16d_private *devpriv = dev->private;
473 	int i;
474 	int chan;
475 	int gain;
476 	int ret;
477 
478 	chan = CR_CHAN(insn->chanspec);
479 	gain = CR_RANGE(insn->chanspec);
480 
481 	/* reset the Analog input circuitry */
482 	/* outw( 0, dev->iobase+AD_CLEAR_REG ); */
483 	/* reset the Analog Input MUX Counter to 0 */
484 	/* outw( 0, dev->iobase+MUX_CNTR_REG ); */
485 
486 	/* set the Input MUX gain */
487 	outw(chan | (gain << 6), dev->iobase + MUX_GAIN_REG);
488 
489 	for (i = 0; i < insn->n; i++) {
490 		/* start the conversion */
491 		outw(0, dev->iobase + START_CONVERT_REG);
492 
493 		/* wait for it to finish */
494 		ret = comedi_timeout(dev, s, insn, atmio16d_ai_eoc, 0);
495 		if (ret)
496 			return ret;
497 
498 		/* read the data now */
499 		data[i] = inw(dev->iobase + AD_FIFO_REG);
500 		/* change to two's complement if need be */
501 		if (devpriv->adc_coding == adc_2comp)
502 			data[i] ^= 0x800;
503 	}
504 
505 	return i;
506 }
507 
atmio16d_ao_insn_write(struct comedi_device * dev,struct comedi_subdevice * s,struct comedi_insn * insn,unsigned int * data)508 static int atmio16d_ao_insn_write(struct comedi_device *dev,
509 				  struct comedi_subdevice *s,
510 				  struct comedi_insn *insn,
511 				  unsigned int *data)
512 {
513 	struct atmio16d_private *devpriv = dev->private;
514 	unsigned int chan = CR_CHAN(insn->chanspec);
515 	unsigned int reg = (chan) ? DAC1_REG : DAC0_REG;
516 	bool munge = false;
517 	int i;
518 
519 	if (chan == 0 && devpriv->dac0_coding == dac_2comp)
520 		munge = true;
521 	if (chan == 1 && devpriv->dac1_coding == dac_2comp)
522 		munge = true;
523 
524 	for (i = 0; i < insn->n; i++) {
525 		unsigned int val = data[i];
526 
527 		s->readback[chan] = val;
528 
529 		if (munge)
530 			val ^= 0x800;
531 
532 		outw(val, dev->iobase + reg);
533 	}
534 
535 	return insn->n;
536 }
537 
atmio16d_dio_insn_bits(struct comedi_device * dev,struct comedi_subdevice * s,struct comedi_insn * insn,unsigned int * data)538 static int atmio16d_dio_insn_bits(struct comedi_device *dev,
539 				  struct comedi_subdevice *s,
540 				  struct comedi_insn *insn,
541 				  unsigned int *data)
542 {
543 	if (comedi_dio_update_state(s, data))
544 		outw(s->state, dev->iobase + MIO_16_DIG_OUT_REG);
545 
546 	data[1] = inw(dev->iobase + MIO_16_DIG_IN_REG);
547 
548 	return insn->n;
549 }
550 
atmio16d_dio_insn_config(struct comedi_device * dev,struct comedi_subdevice * s,struct comedi_insn * insn,unsigned int * data)551 static int atmio16d_dio_insn_config(struct comedi_device *dev,
552 				    struct comedi_subdevice *s,
553 				    struct comedi_insn *insn,
554 				    unsigned int *data)
555 {
556 	struct atmio16d_private *devpriv = dev->private;
557 	unsigned int chan = CR_CHAN(insn->chanspec);
558 	unsigned int mask;
559 	int ret;
560 
561 	if (chan < 4)
562 		mask = 0x0f;
563 	else
564 		mask = 0xf0;
565 
566 	ret = comedi_dio_insn_config(dev, s, insn, data, mask);
567 	if (ret)
568 		return ret;
569 
570 	devpriv->com_reg_2_state &= ~(COMREG2_DOUTEN0 | COMREG2_DOUTEN1);
571 	if (s->io_bits & 0x0f)
572 		devpriv->com_reg_2_state |= COMREG2_DOUTEN0;
573 	if (s->io_bits & 0xf0)
574 		devpriv->com_reg_2_state |= COMREG2_DOUTEN1;
575 	outw(devpriv->com_reg_2_state, dev->iobase + COM_REG_2);
576 
577 	return insn->n;
578 }
579 
atmio16d_attach(struct comedi_device * dev,struct comedi_devconfig * it)580 static int atmio16d_attach(struct comedi_device *dev,
581 			   struct comedi_devconfig *it)
582 {
583 	const struct atmio16_board_t *board = dev->board_ptr;
584 	struct atmio16d_private *devpriv;
585 	struct comedi_subdevice *s;
586 	int ret;
587 
588 	ret = comedi_request_region(dev, it->options[0], 0x20);
589 	if (ret)
590 		return ret;
591 
592 	ret = comedi_alloc_subdevices(dev, 4);
593 	if (ret)
594 		return ret;
595 
596 	devpriv = comedi_alloc_devpriv(dev, sizeof(*devpriv));
597 	if (!devpriv)
598 		return -ENOMEM;
599 
600 	/* reset the atmio16d hardware */
601 	reset_atmio16d(dev);
602 
603 	if (it->options[1]) {
604 		ret = request_irq(it->options[1], atmio16d_interrupt, 0,
605 				  dev->board_name, dev);
606 		if (ret == 0)
607 			dev->irq = it->options[1];
608 	}
609 
610 	/* set device options */
611 	devpriv->adc_mux = it->options[5];
612 	devpriv->adc_range = it->options[6];
613 
614 	devpriv->dac0_range = it->options[7];
615 	devpriv->dac0_reference = it->options[8];
616 	devpriv->dac0_coding = it->options[9];
617 	devpriv->dac1_range = it->options[10];
618 	devpriv->dac1_reference = it->options[11];
619 	devpriv->dac1_coding = it->options[12];
620 
621 	/* setup sub-devices */
622 	s = &dev->subdevices[0];
623 	/* ai subdevice */
624 	s->type = COMEDI_SUBD_AI;
625 	s->subdev_flags = SDF_READABLE | SDF_GROUND;
626 	s->n_chan = (devpriv->adc_mux ? 16 : 8);
627 	s->insn_read = atmio16d_ai_insn_read;
628 	s->maxdata = 0xfff;	/* 4095 decimal */
629 	switch (devpriv->adc_range) {
630 	case adc_bipolar10:
631 		s->range_table = &range_atmio16d_ai_10_bipolar;
632 		break;
633 	case adc_bipolar5:
634 		s->range_table = &range_atmio16d_ai_5_bipolar;
635 		break;
636 	case adc_unipolar10:
637 		s->range_table = &range_atmio16d_ai_unipolar;
638 		break;
639 	}
640 	if (dev->irq) {
641 		dev->read_subdev = s;
642 		s->subdev_flags |= SDF_CMD_READ;
643 		s->len_chanlist = 16;
644 		s->do_cmdtest = atmio16d_ai_cmdtest;
645 		s->do_cmd = atmio16d_ai_cmd;
646 		s->cancel = atmio16d_ai_cancel;
647 	}
648 
649 	/* ao subdevice */
650 	s = &dev->subdevices[1];
651 	s->type = COMEDI_SUBD_AO;
652 	s->subdev_flags = SDF_WRITABLE;
653 	s->n_chan = 2;
654 	s->maxdata = 0xfff;	/* 4095 decimal */
655 	s->range_table_list = devpriv->ao_range_type_list;
656 	switch (devpriv->dac0_range) {
657 	case dac_bipolar:
658 		devpriv->ao_range_type_list[0] = &range_bipolar10;
659 		break;
660 	case dac_unipolar:
661 		devpriv->ao_range_type_list[0] = &range_unipolar10;
662 		break;
663 	}
664 	switch (devpriv->dac1_range) {
665 	case dac_bipolar:
666 		devpriv->ao_range_type_list[1] = &range_bipolar10;
667 		break;
668 	case dac_unipolar:
669 		devpriv->ao_range_type_list[1] = &range_unipolar10;
670 		break;
671 	}
672 	s->insn_write = atmio16d_ao_insn_write;
673 
674 	ret = comedi_alloc_subdev_readback(s);
675 	if (ret)
676 		return ret;
677 
678 	/* Digital I/O */
679 	s = &dev->subdevices[2];
680 	s->type = COMEDI_SUBD_DIO;
681 	s->subdev_flags = SDF_WRITABLE | SDF_READABLE;
682 	s->n_chan = 8;
683 	s->insn_bits = atmio16d_dio_insn_bits;
684 	s->insn_config = atmio16d_dio_insn_config;
685 	s->maxdata = 1;
686 	s->range_table = &range_digital;
687 
688 	/* 8255 subdevice */
689 	s = &dev->subdevices[3];
690 	if (board->has_8255) {
691 		ret = subdev_8255_init(dev, s, NULL, 0x00);
692 		if (ret)
693 			return ret;
694 	} else {
695 		s->type = COMEDI_SUBD_UNUSED;
696 	}
697 
698 /* don't yet know how to deal with counter/timers */
699 #if 0
700 	s = &dev->subdevices[4];
701 	/* do */
702 	s->type = COMEDI_SUBD_TIMER;
703 	s->n_chan = 0;
704 	s->maxdata = 0
705 #endif
706 
707 	return 0;
708 }
709 
atmio16d_detach(struct comedi_device * dev)710 static void atmio16d_detach(struct comedi_device *dev)
711 {
712 	reset_atmio16d(dev);
713 	comedi_legacy_detach(dev);
714 }
715 
716 static const struct atmio16_board_t atmio16_boards[] = {
717 	{
718 		.name		= "atmio16",
719 		.has_8255	= 0,
720 	}, {
721 		.name		= "atmio16d",
722 		.has_8255	= 1,
723 	},
724 };
725 
726 static struct comedi_driver atmio16d_driver = {
727 	.driver_name	= "atmio16",
728 	.module		= THIS_MODULE,
729 	.attach		= atmio16d_attach,
730 	.detach		= atmio16d_detach,
731 	.board_name	= &atmio16_boards[0].name,
732 	.num_names	= ARRAY_SIZE(atmio16_boards),
733 	.offset		= sizeof(struct atmio16_board_t),
734 };
735 module_comedi_driver(atmio16d_driver);
736 
737 MODULE_AUTHOR("Comedi http://www.comedi.org");
738 MODULE_DESCRIPTION("Comedi low-level driver");
739 MODULE_LICENSE("GPL");
740