]>
Commit | Line | Data |
---|---|---|
578c0183 | 1 | /* |
28a2993e HS |
2 | * serial2002.c |
3 | * Comedi driver for serial connected hardware | |
4 | * | |
5 | * COMEDI - Linux Control and Measurement Device Interface | |
6 | * Copyright (C) 2002 Anders Blomdell <anders.blomdell@control.lth.se> | |
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 | */ | |
578c0183 AB |
18 | |
19 | /* | |
28a2993e HS |
20 | * Driver: serial2002 |
21 | * Description: Driver for serial connected hardware | |
22 | * Devices: | |
23 | * Author: Anders Blomdell | |
24 | * Updated: Fri, 7 Jun 2002 12:56:45 -0700 | |
25 | * Status: in development | |
26 | */ | |
578c0183 | 27 | |
ce157f80 | 28 | #include <linux/module.h> |
578c0183 AB |
29 | #include "../comedidev.h" |
30 | ||
31 | #include <linux/delay.h> | |
02921484 | 32 | #include <linux/sched.h> |
5a0e3ad6 | 33 | #include <linux/slab.h> |
d38c59e9 | 34 | #include <linux/ktime.h> |
578c0183 | 35 | |
b041267e | 36 | #include <linux/termios.h> |
578c0183 AB |
37 | #include <asm/ioctls.h> |
38 | #include <linux/serial.h> | |
39 | #include <linux/poll.h> | |
40 | ||
b3fb588d | 41 | struct serial2002_range_table_t { |
2696fb57 | 42 | /* HACK... */ |
578c0183 | 43 | int length; |
1f6325d6 | 44 | struct comedi_krange range; |
b3fb588d BP |
45 | }; |
46 | ||
e21ffa44 | 47 | struct serial2002_private { |
2696fb57 BP |
48 | int port; /* /dev/ttyS<port> */ |
49 | int speed; /* baudrate */ | |
578c0183 | 50 | struct file *tty; |
790c5541 | 51 | unsigned int ao_readback[32]; |
578c0183 AB |
52 | unsigned char digital_in_mapping[32]; |
53 | unsigned char digital_out_mapping[32]; | |
54 | unsigned char analog_in_mapping[32]; | |
55 | unsigned char analog_out_mapping[32]; | |
56 | unsigned char encoder_in_mapping[32]; | |
b3fb588d | 57 | struct serial2002_range_table_t in_range[32], out_range[32]; |
e21ffa44 BP |
58 | }; |
59 | ||
578c0183 AB |
60 | struct serial_data { |
61 | enum { is_invalid, is_digital, is_channel } kind; | |
62 | int index; | |
63 | unsigned long value; | |
64 | }; | |
65 | ||
ee422bb6 HS |
66 | /* |
67 | * The configuration serial_data.value read from the device is | |
68 | * a bitmask that defines specific options of a channel: | |
69 | * | |
70 | * 4:0 - the channel to configure | |
71 | * 7:5 - the kind of channel | |
72 | * 9:8 - the command used to configure the channel | |
73 | * | |
74 | * The remaining bits vary in use depending on the command: | |
75 | * | |
76 | * BITS 15:10 - the channel bits (maxdata) | |
77 | * MIN/MAX 12:10 - the units multiplier for the scale | |
78 | * 13 - the sign of the scale | |
79 | * 33:14 - the base value for the range | |
80 | */ | |
81 | #define S2002_CFG_CHAN(x) ((x) & 0x1f) | |
82 | #define S2002_CFG_KIND(x) (((x) >> 5) & 0x7) | |
83 | #define S2002_CFG_KIND_INVALID 0 | |
84 | #define S2002_CFG_KIND_DIGITAL_IN 1 | |
85 | #define S2002_CFG_KIND_DIGITAL_OUT 2 | |
86 | #define S2002_CFG_KIND_ANALOG_IN 3 | |
87 | #define S2002_CFG_KIND_ANALOG_OUT 4 | |
88 | #define S2002_CFG_KIND_ENCODER_IN 5 | |
89 | #define S2002_CFG_CMD(x) (((x) >> 8) & 0x3) | |
90 | #define S2002_CFG_CMD_BITS 0 | |
91 | #define S2002_CFG_CMD_MIN 1 | |
92 | #define S2002_CFG_CMD_MAX 2 | |
93 | #define S2002_CFG_BITS(x) (((x) >> 10) & 0x3f) | |
94 | #define S2002_CFG_UNITS(x) (((x) >> 10) & 0x7) | |
95 | #define S2002_CFG_SIGN(x) (((x) >> 13) & 0x1) | |
96 | #define S2002_CFG_BASE(x) (((x) >> 14) & 0xfffff) | |
97 | ||
2e3d417c | 98 | static long serial2002_tty_ioctl(struct file *f, unsigned int op, |
a058be68 | 99 | unsigned long param) |
578c0183 | 100 | { |
00a1855c | 101 | if (f->f_op->unlocked_ioctl) |
578c0183 | 102 | return f->f_op->unlocked_ioctl(f, op, param); |
00a1855c | 103 | |
8d63f5b8 | 104 | return -ENOTTY; |
578c0183 AB |
105 | } |
106 | ||
a058be68 | 107 | static int serial2002_tty_write(struct file *f, unsigned char *buf, int count) |
578c0183 | 108 | { |
32ef0e3e | 109 | const char __user *p = (__force const char __user *)buf; |
578c0183 | 110 | int result; |
79ff50c0 | 111 | loff_t offset = 0; |
578c0183 AB |
112 | mm_segment_t oldfs; |
113 | ||
114 | oldfs = get_fs(); | |
115 | set_fs(KERNEL_DS); | |
79ff50c0 | 116 | result = __vfs_write(f, p, count, &offset); |
578c0183 AB |
117 | set_fs(oldfs); |
118 | return result; | |
119 | } | |
120 | ||
a058be68 | 121 | static void serial2002_tty_read_poll_wait(struct file *f, int timeout) |
0a245982 HS |
122 | { |
123 | struct poll_wqueues table; | |
d38c59e9 | 124 | ktime_t start, now; |
0a245982 | 125 | |
d38c59e9 | 126 | start = ktime_get(); |
0a245982 HS |
127 | poll_initwait(&table); |
128 | while (1) { | |
129 | long elapsed; | |
130 | int mask; | |
131 | ||
132 | mask = f->f_op->poll(f, &table.pt); | |
133 | if (mask & (POLLRDNORM | POLLRDBAND | POLLIN | | |
134 | POLLHUP | POLLERR)) { | |
135 | break; | |
136 | } | |
d38c59e9 AJ |
137 | now = ktime_get(); |
138 | elapsed = ktime_us_delta(now, start); | |
0a245982 HS |
139 | if (elapsed > timeout) |
140 | break; | |
141 | set_current_state(TASK_INTERRUPTIBLE); | |
142 | schedule_timeout(((timeout - elapsed) * HZ) / 10000); | |
143 | } | |
144 | poll_freewait(&table); | |
145 | } | |
146 | ||
a058be68 | 147 | static int serial2002_tty_read(struct file *f, int timeout) |
578c0183 | 148 | { |
32ef0e3e | 149 | unsigned char ch; |
578c0183 AB |
150 | int result; |
151 | ||
152 | result = -1; | |
153 | if (!IS_ERR(f)) { | |
154 | mm_segment_t oldfs; | |
79ff50c0 AV |
155 | char __user *p = (__force char __user *)&ch; |
156 | loff_t offset = 0; | |
578c0183 AB |
157 | |
158 | oldfs = get_fs(); | |
159 | set_fs(KERNEL_DS); | |
160 | if (f->f_op->poll) { | |
a058be68 | 161 | serial2002_tty_read_poll_wait(f, timeout); |
578c0183 | 162 | |
79ff50c0 | 163 | if (__vfs_read(f, p, 1, &offset) == 1) |
32ef0e3e | 164 | result = ch; |
578c0183 AB |
165 | } else { |
166 | /* Device does not support poll, busy wait */ | |
167 | int retries = 0; | |
96afd186 | 168 | |
578c0183 | 169 | while (1) { |
578c0183 | 170 | retries++; |
b041267e | 171 | if (retries >= timeout) |
578c0183 | 172 | break; |
578c0183 | 173 | |
79ff50c0 | 174 | if (__vfs_read(f, p, 1, &offset) == 1) { |
356cdbcb | 175 | result = ch; |
578c0183 AB |
176 | break; |
177 | } | |
3335dfd1 | 178 | usleep_range(100, 1000); |
578c0183 AB |
179 | } |
180 | } | |
181 | set_fs(oldfs); | |
182 | } | |
183 | return result; | |
184 | } | |
185 | ||
a058be68 | 186 | static void serial2002_tty_setspeed(struct file *f, int speed) |
578c0183 | 187 | { |
071e0866 HS |
188 | struct termios termios; |
189 | struct serial_struct serial; | |
578c0183 AB |
190 | mm_segment_t oldfs; |
191 | ||
192 | oldfs = get_fs(); | |
193 | set_fs(KERNEL_DS); | |
578c0183 | 194 | |
071e0866 | 195 | /* Set speed */ |
a058be68 | 196 | serial2002_tty_ioctl(f, TCGETS, (unsigned long)&termios); |
071e0866 HS |
197 | termios.c_iflag = 0; |
198 | termios.c_oflag = 0; | |
199 | termios.c_lflag = 0; | |
200 | termios.c_cflag = CLOCAL | CS8 | CREAD; | |
201 | termios.c_cc[VMIN] = 0; | |
202 | termios.c_cc[VTIME] = 0; | |
203 | switch (speed) { | |
204 | case 2400: | |
205 | termios.c_cflag |= B2400; | |
206 | break; | |
207 | case 4800: | |
208 | termios.c_cflag |= B4800; | |
209 | break; | |
210 | case 9600: | |
211 | termios.c_cflag |= B9600; | |
212 | break; | |
213 | case 19200: | |
214 | termios.c_cflag |= B19200; | |
215 | break; | |
216 | case 38400: | |
217 | termios.c_cflag |= B38400; | |
218 | break; | |
219 | case 57600: | |
220 | termios.c_cflag |= B57600; | |
221 | break; | |
222 | case 115200: | |
223 | termios.c_cflag |= B115200; | |
224 | break; | |
225 | default: | |
226 | termios.c_cflag |= B9600; | |
227 | break; | |
578c0183 | 228 | } |
a058be68 | 229 | serial2002_tty_ioctl(f, TCSETS, (unsigned long)&termios); |
071e0866 HS |
230 | |
231 | /* Set low latency */ | |
a058be68 | 232 | serial2002_tty_ioctl(f, TIOCGSERIAL, (unsigned long)&serial); |
071e0866 | 233 | serial.flags |= ASYNC_LOW_LATENCY; |
a058be68 | 234 | serial2002_tty_ioctl(f, TIOCSSERIAL, (unsigned long)&serial); |
578c0183 AB |
235 | |
236 | set_fs(oldfs); | |
237 | } | |
238 | ||
a058be68 | 239 | static void serial2002_poll_digital(struct file *f, int channel) |
578c0183 AB |
240 | { |
241 | char cmd; | |
242 | ||
243 | cmd = 0x40 | (channel & 0x1f); | |
a058be68 | 244 | serial2002_tty_write(f, &cmd, 1); |
578c0183 AB |
245 | } |
246 | ||
a058be68 | 247 | static void serial2002_poll_channel(struct file *f, int channel) |
578c0183 AB |
248 | { |
249 | char cmd; | |
250 | ||
251 | cmd = 0x60 | (channel & 0x1f); | |
a058be68 | 252 | serial2002_tty_write(f, &cmd, 1); |
578c0183 AB |
253 | } |
254 | ||
a058be68 | 255 | static struct serial_data serial2002_read(struct file *f, int timeout) |
578c0183 AB |
256 | { |
257 | struct serial_data result; | |
258 | int length; | |
259 | ||
260 | result.kind = is_invalid; | |
261 | result.index = 0; | |
262 | result.value = 0; | |
263 | length = 0; | |
264 | while (1) { | |
a058be68 | 265 | int data = serial2002_tty_read(f, timeout); |
578c0183 AB |
266 | |
267 | length++; | |
268 | if (data < 0) { | |
578c0183 AB |
269 | break; |
270 | } else if (data & 0x80) { | |
271 | result.value = (result.value << 7) | (data & 0x7f); | |
272 | } else { | |
273 | if (length == 1) { | |
274 | switch ((data >> 5) & 0x03) { | |
761a38a4 HS |
275 | case 0: |
276 | result.value = 0; | |
277 | result.kind = is_digital; | |
578c0183 | 278 | break; |
761a38a4 HS |
279 | case 1: |
280 | result.value = 1; | |
281 | result.kind = is_digital; | |
578c0183 AB |
282 | break; |
283 | } | |
284 | } else { | |
285 | result.value = | |
0a85b6f0 | 286 | (result.value << 2) | ((data & 0x60) >> 5); |
578c0183 AB |
287 | result.kind = is_channel; |
288 | } | |
289 | result.index = data & 0x1f; | |
290 | break; | |
291 | } | |
292 | } | |
293 | return result; | |
578c0183 AB |
294 | } |
295 | ||
a058be68 | 296 | static void serial2002_write(struct file *f, struct serial_data data) |
578c0183 AB |
297 | { |
298 | if (data.kind == is_digital) { | |
299 | unsigned char ch = | |
0a85b6f0 | 300 | ((data.value << 5) & 0x20) | (data.index & 0x1f); |
a058be68 | 301 | serial2002_tty_write(f, &ch, 1); |
578c0183 AB |
302 | } else { |
303 | unsigned char ch[6]; | |
304 | int i = 0; | |
96afd186 | 305 | |
578c0183 AB |
306 | if (data.value >= (1L << 30)) { |
307 | ch[i] = 0x80 | ((data.value >> 30) & 0x03); | |
308 | i++; | |
309 | } | |
310 | if (data.value >= (1L << 23)) { | |
311 | ch[i] = 0x80 | ((data.value >> 23) & 0x7f); | |
312 | i++; | |
313 | } | |
314 | if (data.value >= (1L << 16)) { | |
315 | ch[i] = 0x80 | ((data.value >> 16) & 0x7f); | |
316 | i++; | |
317 | } | |
318 | if (data.value >= (1L << 9)) { | |
319 | ch[i] = 0x80 | ((data.value >> 9) & 0x7f); | |
320 | i++; | |
321 | } | |
322 | ch[i] = 0x80 | ((data.value >> 2) & 0x7f); | |
323 | i++; | |
324 | ch[i] = ((data.value << 5) & 0x60) | (data.index & 0x1f); | |
325 | i++; | |
a058be68 | 326 | serial2002_tty_write(f, ch, i); |
578c0183 AB |
327 | } |
328 | } | |
329 | ||
623a7392 HS |
330 | struct config_t { |
331 | short int kind; | |
332 | short int bits; | |
333 | int min; | |
334 | int max; | |
335 | }; | |
336 | ||
337 | static int serial2002_setup_subdevice(struct comedi_subdevice *s, | |
338 | struct config_t *cfg, | |
339 | struct serial2002_range_table_t *range, | |
340 | unsigned char *mapping, | |
341 | int kind) | |
342 | { | |
343 | const struct comedi_lrange **range_table_list = NULL; | |
344 | unsigned int *maxdata_list; | |
345 | int j, chan; | |
346 | ||
347 | for (chan = 0, j = 0; j < 32; j++) { | |
348 | if (cfg[j].kind == kind) | |
349 | chan++; | |
350 | } | |
351 | s->n_chan = chan; | |
352 | s->maxdata = 0; | |
353 | kfree(s->maxdata_list); | |
205781b7 HS |
354 | maxdata_list = kmalloc_array(s->n_chan, sizeof(unsigned int), |
355 | GFP_KERNEL); | |
623a7392 HS |
356 | if (!maxdata_list) |
357 | return -ENOMEM; | |
358 | s->maxdata_list = maxdata_list; | |
359 | kfree(s->range_table_list); | |
360 | s->range_table = NULL; | |
361 | s->range_table_list = NULL; | |
362 | if (kind == 1 || kind == 2) { | |
363 | s->range_table = &range_digital; | |
364 | } else if (range) { | |
205781b7 HS |
365 | range_table_list = kmalloc_array(s->n_chan, sizeof(*range), |
366 | GFP_KERNEL); | |
623a7392 HS |
367 | if (!range_table_list) |
368 | return -ENOMEM; | |
369 | s->range_table_list = range_table_list; | |
370 | } | |
371 | for (chan = 0, j = 0; j < 32; j++) { | |
372 | if (cfg[j].kind == kind) { | |
373 | if (mapping) | |
374 | mapping[chan] = j; | |
a437dee5 | 375 | if (range && range_table_list) { |
623a7392 HS |
376 | range[j].length = 1; |
377 | range[j].range.min = cfg[j].min; | |
378 | range[j].range.max = cfg[j].max; | |
379 | range_table_list[chan] = | |
380 | (const struct comedi_lrange *)&range[j]; | |
381 | } | |
c9b0f2b6 CC |
382 | if (cfg[j].bits < 32) |
383 | maxdata_list[chan] = (1u << cfg[j].bits) - 1; | |
384 | else | |
385 | maxdata_list[chan] = 0xffffffff; | |
623a7392 HS |
386 | chan++; |
387 | } | |
388 | } | |
389 | return 0; | |
390 | } | |
391 | ||
392 | static int serial2002_setup_subdevs(struct comedi_device *dev) | |
578c0183 | 393 | { |
9a1a6cf8 | 394 | struct serial2002_private *devpriv = dev->private; |
623a7392 HS |
395 | struct config_t *di_cfg; |
396 | struct config_t *do_cfg; | |
397 | struct config_t *ai_cfg; | |
398 | struct config_t *ao_cfg; | |
399 | struct config_t *cfg; | |
400 | struct comedi_subdevice *s; | |
ee422bb6 | 401 | int result = 0; |
623a7392 HS |
402 | int i; |
403 | ||
ee422bb6 | 404 | /* Allocate the temporary structs to hold the configuration data */ |
623a7392 HS |
405 | di_cfg = kcalloc(32, sizeof(*cfg), GFP_KERNEL); |
406 | do_cfg = kcalloc(32, sizeof(*cfg), GFP_KERNEL); | |
407 | ai_cfg = kcalloc(32, sizeof(*cfg), GFP_KERNEL); | |
408 | ao_cfg = kcalloc(32, sizeof(*cfg), GFP_KERNEL); | |
409 | if (!di_cfg || !do_cfg || !ai_cfg || !ao_cfg) { | |
410 | result = -ENOMEM; | |
411 | goto err_alloc_configs; | |
412 | } | |
578c0183 | 413 | |
ee422bb6 | 414 | /* Read the configuration from the connected device */ |
a058be68 HS |
415 | serial2002_tty_setspeed(devpriv->tty, devpriv->speed); |
416 | serial2002_poll_channel(devpriv->tty, 31); | |
623a7392 | 417 | while (1) { |
624e6446 HS |
418 | struct serial_data data = serial2002_read(devpriv->tty, 1000); |
419 | int kind = S2002_CFG_KIND(data.value); | |
420 | int channel = S2002_CFG_CHAN(data.value); | |
421 | int range = S2002_CFG_BASE(data.value); | |
422 | int cmd = S2002_CFG_CMD(data.value); | |
578c0183 | 423 | |
623a7392 | 424 | if (data.kind != is_channel || data.index != 31 || |
624e6446 | 425 | kind == S2002_CFG_KIND_INVALID) |
623a7392 | 426 | break; |
578c0183 | 427 | |
624e6446 HS |
428 | switch (kind) { |
429 | case S2002_CFG_KIND_DIGITAL_IN: | |
430 | cfg = di_cfg; | |
431 | break; | |
432 | case S2002_CFG_KIND_DIGITAL_OUT: | |
433 | cfg = do_cfg; | |
434 | break; | |
435 | case S2002_CFG_KIND_ANALOG_IN: | |
436 | cfg = ai_cfg; | |
437 | break; | |
438 | case S2002_CFG_KIND_ANALOG_OUT: | |
439 | cfg = ao_cfg; | |
440 | break; | |
441 | case S2002_CFG_KIND_ENCODER_IN: | |
442 | cfg = ai_cfg; | |
443 | break; | |
444 | default: | |
445 | cfg = NULL; | |
446 | break; | |
447 | } | |
448 | if (!cfg) | |
449 | continue; /* unknown kind, skip it */ | |
623a7392 | 450 | |
624e6446 | 451 | cfg[channel].kind = kind; |
623a7392 | 452 | |
624e6446 HS |
453 | switch (cmd) { |
454 | case S2002_CFG_CMD_BITS: | |
455 | cfg[channel].bits = S2002_CFG_BITS(data.value); | |
456 | break; | |
457 | case S2002_CFG_CMD_MIN: | |
458 | case S2002_CFG_CMD_MAX: | |
459 | switch (S2002_CFG_UNITS(data.value)) { | |
460 | case 0: | |
461 | range *= 1000000; | |
ee422bb6 | 462 | break; |
624e6446 HS |
463 | case 1: |
464 | range *= 1000; | |
465 | break; | |
466 | case 2: | |
467 | range *= 1; | |
ee422bb6 | 468 | break; |
578c0183 | 469 | } |
624e6446 HS |
470 | if (S2002_CFG_SIGN(data.value)) |
471 | range = -range; | |
472 | if (cmd == S2002_CFG_CMD_MIN) | |
473 | cfg[channel].min = range; | |
474 | else | |
475 | cfg[channel].max = range; | |
476 | break; | |
578c0183 | 477 | } |
623a7392 HS |
478 | } |
479 | ||
480 | /* Fill in subdevice data */ | |
481 | for (i = 0; i <= 4; i++) { | |
482 | unsigned char *mapping = NULL; | |
483 | struct serial2002_range_table_t *range = NULL; | |
484 | int kind = 0; | |
485 | ||
ee422bb6 HS |
486 | s = &dev->subdevices[i]; |
487 | ||
623a7392 HS |
488 | switch (i) { |
489 | case 0: | |
490 | cfg = di_cfg; | |
491 | mapping = devpriv->digital_in_mapping; | |
ee422bb6 | 492 | kind = S2002_CFG_KIND_DIGITAL_IN; |
623a7392 HS |
493 | break; |
494 | case 1: | |
495 | cfg = do_cfg; | |
496 | mapping = devpriv->digital_out_mapping; | |
ee422bb6 | 497 | kind = S2002_CFG_KIND_DIGITAL_OUT; |
623a7392 HS |
498 | break; |
499 | case 2: | |
500 | cfg = ai_cfg; | |
501 | mapping = devpriv->analog_in_mapping; | |
502 | range = devpriv->in_range; | |
ee422bb6 | 503 | kind = S2002_CFG_KIND_ANALOG_IN; |
623a7392 HS |
504 | break; |
505 | case 3: | |
506 | cfg = ao_cfg; | |
507 | mapping = devpriv->analog_out_mapping; | |
508 | range = devpriv->out_range; | |
ee422bb6 | 509 | kind = S2002_CFG_KIND_ANALOG_OUT; |
623a7392 HS |
510 | break; |
511 | case 4: | |
512 | cfg = ai_cfg; | |
513 | mapping = devpriv->encoder_in_mapping; | |
514 | range = devpriv->in_range; | |
ee422bb6 | 515 | kind = S2002_CFG_KIND_ENCODER_IN; |
623a7392 | 516 | break; |
578c0183 | 517 | } |
623a7392 | 518 | |
ee422bb6 HS |
519 | if (serial2002_setup_subdevice(s, cfg, range, mapping, kind)) |
520 | break; /* err handled below */ | |
623a7392 HS |
521 | } |
522 | if (i <= 4) { | |
523 | /* | |
524 | * Failed to allocate maxdata_list or range_table_list | |
525 | * for a subdevice that needed it. | |
526 | */ | |
527 | result = -ENOMEM; | |
528 | for (i = 0; i <= 4; i++) { | |
529 | s = &dev->subdevices[i]; | |
530 | kfree(s->maxdata_list); | |
531 | s->maxdata_list = NULL; | |
532 | kfree(s->range_table_list); | |
533 | s->range_table_list = NULL; | |
9e7f2256 | 534 | } |
623a7392 | 535 | } |
668f272e IA |
536 | |
537 | err_alloc_configs: | |
623a7392 HS |
538 | kfree(di_cfg); |
539 | kfree(do_cfg); | |
540 | kfree(ai_cfg); | |
541 | kfree(ao_cfg); | |
542 | ||
543 | if (result) { | |
544 | if (devpriv->tty) { | |
545 | filp_close(devpriv->tty, NULL); | |
546 | devpriv->tty = NULL; | |
9e7f2256 | 547 | } |
578c0183 | 548 | } |
623a7392 HS |
549 | |
550 | return result; | |
551 | } | |
552 | ||
a058be68 | 553 | static int serial2002_open(struct comedi_device *dev) |
623a7392 HS |
554 | { |
555 | struct serial2002_private *devpriv = dev->private; | |
556 | int result; | |
557 | char port[20]; | |
558 | ||
559 | sprintf(port, "/dev/ttyS%d", devpriv->port); | |
560 | devpriv->tty = filp_open(port, O_RDWR, 0); | |
561 | if (IS_ERR(devpriv->tty)) { | |
562 | result = (int)PTR_ERR(devpriv->tty); | |
563 | dev_err(dev->class_dev, "file open error = %d\n", result); | |
564 | } else { | |
565 | result = serial2002_setup_subdevs(dev); | |
566 | } | |
3c17ba07 | 567 | return result; |
578c0183 AB |
568 | } |
569 | ||
a058be68 | 570 | static void serial2002_close(struct comedi_device *dev) |
578c0183 | 571 | { |
9a1a6cf8 HS |
572 | struct serial2002_private *devpriv = dev->private; |
573 | ||
27494c09 HS |
574 | if (!IS_ERR(devpriv->tty) && devpriv->tty) |
575 | filp_close(devpriv->tty, NULL); | |
578c0183 AB |
576 | } |
577 | ||
adbd1741 HS |
578 | static int serial2002_di_insn_read(struct comedi_device *dev, |
579 | struct comedi_subdevice *s, | |
580 | struct comedi_insn *insn, | |
581 | unsigned int *data) | |
578c0183 | 582 | { |
9a1a6cf8 | 583 | struct serial2002_private *devpriv = dev->private; |
578c0183 AB |
584 | int n; |
585 | int chan; | |
586 | ||
587 | chan = devpriv->digital_in_mapping[CR_CHAN(insn->chanspec)]; | |
588 | for (n = 0; n < insn->n; n++) { | |
589 | struct serial_data read; | |
590 | ||
a058be68 | 591 | serial2002_poll_digital(devpriv->tty, chan); |
578c0183 | 592 | while (1) { |
a058be68 | 593 | read = serial2002_read(devpriv->tty, 1000); |
e9d1cf89 | 594 | if (read.kind != is_digital || read.index == chan) |
578c0183 | 595 | break; |
578c0183 AB |
596 | } |
597 | data[n] = read.value; | |
598 | } | |
599 | return n; | |
600 | } | |
601 | ||
adbd1741 HS |
602 | static int serial2002_do_insn_write(struct comedi_device *dev, |
603 | struct comedi_subdevice *s, | |
604 | struct comedi_insn *insn, | |
605 | unsigned int *data) | |
578c0183 | 606 | { |
9a1a6cf8 | 607 | struct serial2002_private *devpriv = dev->private; |
578c0183 AB |
608 | int n; |
609 | int chan; | |
610 | ||
611 | chan = devpriv->digital_out_mapping[CR_CHAN(insn->chanspec)]; | |
612 | for (n = 0; n < insn->n; n++) { | |
613 | struct serial_data write; | |
614 | ||
615 | write.kind = is_digital; | |
616 | write.index = chan; | |
617 | write.value = data[n]; | |
a058be68 | 618 | serial2002_write(devpriv->tty, write); |
578c0183 AB |
619 | } |
620 | return n; | |
621 | } | |
622 | ||
adbd1741 HS |
623 | static int serial2002_ai_insn_read(struct comedi_device *dev, |
624 | struct comedi_subdevice *s, | |
625 | struct comedi_insn *insn, | |
626 | unsigned int *data) | |
578c0183 | 627 | { |
9a1a6cf8 | 628 | struct serial2002_private *devpriv = dev->private; |
578c0183 AB |
629 | int n; |
630 | int chan; | |
631 | ||
632 | chan = devpriv->analog_in_mapping[CR_CHAN(insn->chanspec)]; | |
633 | for (n = 0; n < insn->n; n++) { | |
634 | struct serial_data read; | |
635 | ||
a058be68 | 636 | serial2002_poll_channel(devpriv->tty, chan); |
578c0183 | 637 | while (1) { |
a058be68 | 638 | read = serial2002_read(devpriv->tty, 1000); |
e9d1cf89 | 639 | if (read.kind != is_channel || read.index == chan) |
578c0183 | 640 | break; |
578c0183 AB |
641 | } |
642 | data[n] = read.value; | |
643 | } | |
644 | return n; | |
645 | } | |
646 | ||
adbd1741 HS |
647 | static int serial2002_ao_insn_write(struct comedi_device *dev, |
648 | struct comedi_subdevice *s, | |
649 | struct comedi_insn *insn, | |
650 | unsigned int *data) | |
578c0183 | 651 | { |
9a1a6cf8 | 652 | struct serial2002_private *devpriv = dev->private; |
578c0183 AB |
653 | int n; |
654 | int chan; | |
655 | ||
656 | chan = devpriv->analog_out_mapping[CR_CHAN(insn->chanspec)]; | |
657 | for (n = 0; n < insn->n; n++) { | |
658 | struct serial_data write; | |
659 | ||
660 | write.kind = is_channel; | |
661 | write.index = chan; | |
662 | write.value = data[n]; | |
a058be68 | 663 | serial2002_write(devpriv->tty, write); |
578c0183 AB |
664 | devpriv->ao_readback[chan] = data[n]; |
665 | } | |
666 | return n; | |
667 | } | |
668 | ||
adbd1741 HS |
669 | static int serial2002_ao_insn_read(struct comedi_device *dev, |
670 | struct comedi_subdevice *s, | |
671 | struct comedi_insn *insn, | |
672 | unsigned int *data) | |
578c0183 | 673 | { |
9a1a6cf8 | 674 | struct serial2002_private *devpriv = dev->private; |
578c0183 AB |
675 | int n; |
676 | int chan = CR_CHAN(insn->chanspec); | |
677 | ||
e9d1cf89 | 678 | for (n = 0; n < insn->n; n++) |
578c0183 | 679 | data[n] = devpriv->ao_readback[chan]; |
578c0183 AB |
680 | |
681 | return n; | |
682 | } | |
683 | ||
adbd1741 HS |
684 | static int serial2002_encoder_insn_read(struct comedi_device *dev, |
685 | struct comedi_subdevice *s, | |
686 | struct comedi_insn *insn, | |
687 | unsigned int *data) | |
578c0183 | 688 | { |
9a1a6cf8 | 689 | struct serial2002_private *devpriv = dev->private; |
578c0183 AB |
690 | int n; |
691 | int chan; | |
692 | ||
693 | chan = devpriv->encoder_in_mapping[CR_CHAN(insn->chanspec)]; | |
694 | for (n = 0; n < insn->n; n++) { | |
695 | struct serial_data read; | |
696 | ||
a058be68 | 697 | serial2002_poll_channel(devpriv->tty, chan); |
578c0183 | 698 | while (1) { |
a058be68 | 699 | read = serial2002_read(devpriv->tty, 1000); |
e9d1cf89 | 700 | if (read.kind != is_channel || read.index == chan) |
578c0183 | 701 | break; |
578c0183 AB |
702 | } |
703 | data[n] = read.value; | |
704 | } | |
705 | return n; | |
706 | } | |
707 | ||
0a85b6f0 MT |
708 | static int serial2002_attach(struct comedi_device *dev, |
709 | struct comedi_devconfig *it) | |
578c0183 | 710 | { |
9a1a6cf8 | 711 | struct serial2002_private *devpriv; |
34c43922 | 712 | struct comedi_subdevice *s; |
8b6c5694 | 713 | int ret; |
578c0183 | 714 | |
0bdab509 | 715 | devpriv = comedi_alloc_devpriv(dev, sizeof(*devpriv)); |
c34fa261 HS |
716 | if (!devpriv) |
717 | return -ENOMEM; | |
9a1a6cf8 | 718 | |
578c0183 AB |
719 | devpriv->port = it->options[0]; |
720 | devpriv->speed = it->options[1]; | |
578c0183 | 721 | |
8b6c5694 HS |
722 | ret = comedi_alloc_subdevices(dev, 5); |
723 | if (ret) | |
724 | return ret; | |
578c0183 AB |
725 | |
726 | /* digital input subdevice */ | |
8e27a730 | 727 | s = &dev->subdevices[0]; |
adbd1741 HS |
728 | s->type = COMEDI_SUBD_DI; |
729 | s->subdev_flags = SDF_READABLE; | |
730 | s->n_chan = 0; | |
731 | s->maxdata = 1; | |
732 | s->range_table = &range_digital; | |
733 | s->insn_read = serial2002_di_insn_read; | |
578c0183 AB |
734 | |
735 | /* digital output subdevice */ | |
8e27a730 | 736 | s = &dev->subdevices[1]; |
adbd1741 | 737 | s->type = COMEDI_SUBD_DO; |
ef49d832 | 738 | s->subdev_flags = SDF_WRITABLE; |
adbd1741 HS |
739 | s->n_chan = 0; |
740 | s->maxdata = 1; | |
741 | s->range_table = &range_digital; | |
742 | s->insn_write = serial2002_do_insn_write; | |
578c0183 AB |
743 | |
744 | /* analog input subdevice */ | |
8e27a730 | 745 | s = &dev->subdevices[2]; |
adbd1741 HS |
746 | s->type = COMEDI_SUBD_AI; |
747 | s->subdev_flags = SDF_READABLE | SDF_GROUND; | |
748 | s->n_chan = 0; | |
749 | s->maxdata = 1; | |
750 | s->range_table = NULL; | |
751 | s->insn_read = serial2002_ai_insn_read; | |
578c0183 AB |
752 | |
753 | /* analog output subdevice */ | |
8e27a730 | 754 | s = &dev->subdevices[3]; |
adbd1741 | 755 | s->type = COMEDI_SUBD_AO; |
ef49d832 | 756 | s->subdev_flags = SDF_WRITABLE; |
adbd1741 HS |
757 | s->n_chan = 0; |
758 | s->maxdata = 1; | |
759 | s->range_table = NULL; | |
760 | s->insn_write = serial2002_ao_insn_write; | |
761 | s->insn_read = serial2002_ao_insn_read; | |
578c0183 AB |
762 | |
763 | /* encoder input subdevice */ | |
8e27a730 | 764 | s = &dev->subdevices[4]; |
adbd1741 HS |
765 | s->type = COMEDI_SUBD_COUNTER; |
766 | s->subdev_flags = SDF_READABLE | SDF_LSAMPL; | |
767 | s->n_chan = 0; | |
768 | s->maxdata = 1; | |
769 | s->range_table = NULL; | |
770 | s->insn_read = serial2002_encoder_insn_read; | |
578c0183 | 771 | |
a058be68 HS |
772 | dev->open = serial2002_open; |
773 | dev->close = serial2002_close; | |
e7ccc452 | 774 | |
81c01c3f | 775 | return 0; |
578c0183 AB |
776 | } |
777 | ||
484ecc95 | 778 | static void serial2002_detach(struct comedi_device *dev) |
578c0183 | 779 | { |
34c43922 | 780 | struct comedi_subdevice *s; |
578c0183 AB |
781 | int i; |
782 | ||
fd47579b | 783 | for (i = 0; i < dev->n_subdevices; i++) { |
578c0183 | 784 | s = &dev->subdevices[i]; |
e4e1f289 IM |
785 | kfree(s->maxdata_list); |
786 | kfree(s->range_table_list); | |
578c0183 | 787 | } |
578c0183 AB |
788 | } |
789 | ||
294f930d | 790 | static struct comedi_driver serial2002_driver = { |
cb1648b4 HS |
791 | .driver_name = "serial2002", |
792 | .module = THIS_MODULE, | |
793 | .attach = serial2002_attach, | |
794 | .detach = serial2002_detach, | |
cb1648b4 | 795 | }; |
294f930d | 796 | module_comedi_driver(serial2002_driver); |
90f703d3 AT |
797 | |
798 | MODULE_AUTHOR("Comedi http://www.comedi.org"); | |
799 | MODULE_DESCRIPTION("Comedi low-level driver"); | |
800 | MODULE_LICENSE("GPL"); |