2 * comedi/drivers/dt9812.c
3 * COMEDI driver for DataTranslation DT9812 USB module
5 * Copyright (C) 2005 Anders Blomdell <anders.blomdell@control.lth.se>
7 * COMEDI - Linux Control and Measurement Device Interface
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
27 Description: Data Translation DT9812 USB module
28 Author: anders.blomdell@control.lth.se (Anders Blomdell)
29 Status: in development
30 Devices: [Data Translation] DT9812 (dt9812)
31 Updated: Sun Nov 20 20:18:34 EST 2005
33 This driver works, but bulk transfers not implemented. Might be a starting point
34 for someone else. I found out too late that USB has too high latencies (>1 ms)
40 * 1. All writes to command pipe has to be 32 bytes (ISP1181B SHRTP=0 ?)
41 * 2. The DDK source (as of sep 2005) is in error regarding the
42 * input MUX bits (example code says P4, but firmware schematics
46 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
48 #include <linux/kernel.h>
49 #include <linux/errno.h>
50 #include <linux/init.h>
51 #include <linux/slab.h>
52 #include <linux/module.h>
53 #include <linux/kref.h>
54 #include <linux/uaccess.h>
55 #include <linux/usb.h>
57 #include "../comedidev.h"
59 #define DT9812_DIAGS_BOARD_INFO_ADDR 0xFBFF
60 #define DT9812_MAX_WRITE_CMD_PIPE_SIZE 32
61 #define DT9812_MAX_READ_CMD_PIPE_SIZE 32
64 * See Silican Laboratories C8051F020/1/2/3 manual
66 #define F020_SFR_P4 0x84
67 #define F020_SFR_P1 0x90
68 #define F020_SFR_P2 0xa0
69 #define F020_SFR_P3 0xb0
70 #define F020_SFR_AMX0CF 0xba
71 #define F020_SFR_AMX0SL 0xbb
72 #define F020_SFR_ADC0CF 0xbc
73 #define F020_SFR_ADC0L 0xbe
74 #define F020_SFR_ADC0H 0xbf
75 #define F020_SFR_DAC0L 0xd2
76 #define F020_SFR_DAC0H 0xd3
77 #define F020_SFR_DAC0CN 0xd4
78 #define F020_SFR_DAC1L 0xd5
79 #define F020_SFR_DAC1H 0xd6
80 #define F020_SFR_DAC1CN 0xd7
81 #define F020_SFR_ADC0CN 0xe8
83 #define F020_MASK_ADC0CF_AMP0GN0 0x01
84 #define F020_MASK_ADC0CF_AMP0GN1 0x02
85 #define F020_MASK_ADC0CF_AMP0GN2 0x04
87 #define F020_MASK_ADC0CN_AD0EN 0x80
88 #define F020_MASK_ADC0CN_AD0INT 0x20
89 #define F020_MASK_ADC0CN_AD0BUSY 0x10
91 #define F020_MASK_DACxCN_DACxEN 0x80
94 /* A/D D/A DI DO CT */
95 DT9812_DEVID_DT9812_10, /* 8 2 8 8 1 +/- 10V */
96 DT9812_DEVID_DT9812_2PT5, /* 8 2 8 8 1 0-2.44V */
98 DT9812_DEVID_DT9813, /* 16 2 4 4 1 +/- 10V */
99 DT9812_DEVID_DT9814 /* 24 2 0 0 1 +/- 10V */
104 DT9812_GAIN_0PT25 = 1,
105 DT9812_GAIN_0PT5 = 2,
114 DT9812_LEAST_USB_FIRMWARE_CMD_CODE = 0,
115 /* Write Flash memory */
116 DT9812_W_FLASH_DATA = 0,
117 /* Read Flash memory misc config info */
118 DT9812_R_FLASH_DATA = 1,
121 * Register read/write commands for processor
124 /* Read a single byte of USB memory */
125 DT9812_R_SINGLE_BYTE_REG = 2,
126 /* Write a single byte of USB memory */
127 DT9812_W_SINGLE_BYTE_REG = 3,
128 /* Multiple Reads of USB memory */
129 DT9812_R_MULTI_BYTE_REG = 4,
130 /* Multiple Writes of USB memory */
131 DT9812_W_MULTI_BYTE_REG = 5,
132 /* Read, (AND) with mask, OR value, then write (single) */
133 DT9812_RMW_SINGLE_BYTE_REG = 6,
134 /* Read, (AND) with mask, OR value, then write (multiple) */
135 DT9812_RMW_MULTI_BYTE_REG = 7,
138 * Register read/write commands for SMBus
141 /* Read a single byte of SMBus */
142 DT9812_R_SINGLE_BYTE_SMBUS = 8,
143 /* Write a single byte of SMBus */
144 DT9812_W_SINGLE_BYTE_SMBUS = 9,
145 /* Multiple Reads of SMBus */
146 DT9812_R_MULTI_BYTE_SMBUS = 10,
147 /* Multiple Writes of SMBus */
148 DT9812_W_MULTI_BYTE_SMBUS = 11,
151 * Register read/write commands for a device
154 /* Read a single byte of a device */
155 DT9812_R_SINGLE_BYTE_DEV = 12,
156 /* Write a single byte of a device */
157 DT9812_W_SINGLE_BYTE_DEV = 13,
158 /* Multiple Reads of a device */
159 DT9812_R_MULTI_BYTE_DEV = 14,
160 /* Multiple Writes of a device */
161 DT9812_W_MULTI_BYTE_DEV = 15,
163 /* Not sure if we'll need this */
164 DT9812_W_DAC_THRESHOLD = 16,
166 /* Set interrupt on change mask */
167 DT9812_W_INT_ON_CHANGE_MASK = 17,
169 /* Write (or Clear) the CGL for the ADC */
171 /* Multiple Reads of USB memory */
172 DT9812_R_MULTI_BYTE_USBMEM = 19,
173 /* Multiple Writes to USB memory */
174 DT9812_W_MULTI_BYTE_USBMEM = 20,
176 /* Issue a start command to a given subsystem */
177 DT9812_START_SUBSYSTEM = 21,
178 /* Issue a stop command to a given subsystem */
179 DT9812_STOP_SUBSYSTEM = 22,
181 /* calibrate the board using CAL_POT_CMD */
182 DT9812_CALIBRATE_POT = 23,
183 /* set the DAC FIFO size */
184 DT9812_W_DAC_FIFO_SIZE = 24,
185 /* Write or Clear the CGL for the DAC */
186 DT9812_W_CGL_DAC = 25,
187 /* Read a single value from a subsystem */
188 DT9812_R_SINGLE_VALUE_CMD = 26,
189 /* Write a single value to a subsystem */
190 DT9812_W_SINGLE_VALUE_CMD = 27,
191 /* Valid DT9812_USB_FIRMWARE_CMD_CODE's will be less than this number */
192 DT9812_MAX_USB_FIRMWARE_CMD_CODE,
195 struct dt9812_flash_data {
200 #define DT9812_MAX_NUM_MULTI_BYTE_RDS \
201 ((DT9812_MAX_WRITE_CMD_PIPE_SIZE - 4 - 1) / sizeof(u8))
203 struct dt9812_read_multi {
205 u8 address[DT9812_MAX_NUM_MULTI_BYTE_RDS];
208 struct dt9812_write_byte {
213 #define DT9812_MAX_NUM_MULTI_BYTE_WRTS \
214 ((DT9812_MAX_WRITE_CMD_PIPE_SIZE - 4 - 1) / \
215 sizeof(struct dt9812_write_byte))
217 struct dt9812_write_multi {
219 struct dt9812_write_byte write[DT9812_MAX_NUM_MULTI_BYTE_WRTS];
222 struct dt9812_rmw_byte {
228 #define DT9812_MAX_NUM_MULTI_BYTE_RMWS \
229 ((DT9812_MAX_WRITE_CMD_PIPE_SIZE - 4 - 1) / \
230 sizeof(struct dt9812_rmw_byte))
232 struct dt9812_rmw_multi {
234 struct dt9812_rmw_byte rmw[DT9812_MAX_NUM_MULTI_BYTE_RMWS];
237 struct dt9812_usb_cmd {
240 struct dt9812_flash_data flash_data_info;
241 struct dt9812_read_multi read_multi_info;
242 struct dt9812_write_multi write_multi_info;
243 struct dt9812_rmw_multi rmw_multi_info;
246 WRITE_BYTE_INFO WriteByteInfo;
247 READ_BYTE_INFO ReadByteInfo;
248 WRITE_MULTI_INFO WriteMultiInfo;
249 READ_MULTI_INFO ReadMultiInfo;
250 RMW_BYTE_INFO RMWByteInfo;
251 RMW_MULTI_INFO RMWMultiInfo;
252 DAC_THRESHOLD_INFO DacThresholdInfo;
253 INT_ON_CHANGE_MASK_INFO IntOnChangeMaskInfo;
255 SUBSYSTEM_INFO SubsystemInfo;
256 CAL_POT_CMD CalPotCmd;
257 WRITE_DEV_BYTE_INFO WriteDevByteInfo;
258 READ_DEV_BYTE_INFO ReadDevByteInfo;
259 WRITE_DEV_MULTI_INFO WriteDevMultiInfo;
260 READ_DEV_MULTI_INFO ReadDevMultiInfo;
261 READ_SINGLE_VALUE_INFO ReadSingleValueInfo;
262 WRITE_SINGLE_VALUE_INFO WriteSingleValueInfo;
266 #define DT9812_NUM_SLOTS 16
268 static DEFINE_SEMAPHORE(dt9812_mutex);
270 static const struct usb_device_id dt9812_table[] = {
271 {USB_DEVICE(0x0867, 0x9812)},
272 {} /* Terminating entry */
275 MODULE_DEVICE_TABLE(usb, dt9812_table);
278 struct slot_dt9812 *slot;
279 struct usb_device *udev;
280 struct usb_interface *interface;
288 } message_pipe, command_write, command_read, write_stream, read_stream;
290 u16 analog_out_shadow[2];
291 u8 digital_out_shadow;
294 struct comedi_dt9812 {
295 struct slot_dt9812 *slot;
300 struct semaphore mutex;
302 struct usb_dt9812 *usb;
303 struct comedi_dt9812 *comedi;
306 static struct slot_dt9812 dt9812[DT9812_NUM_SLOTS];
308 static inline struct usb_dt9812 *to_dt9812_dev(struct kref *d)
310 return container_of(d, struct usb_dt9812, kref);
313 static void dt9812_delete(struct kref *kref)
315 struct usb_dt9812 *dev = to_dt9812_dev(kref);
317 usb_put_dev(dev->udev);
321 static int dt9812_read_info(struct usb_dt9812 *dev, int offset, void *buf,
324 struct dt9812_usb_cmd cmd;
327 cmd.cmd = cpu_to_le32(DT9812_R_FLASH_DATA);
328 cmd.u.flash_data_info.address =
329 cpu_to_le16(DT9812_DIAGS_BOARD_INFO_ADDR + offset);
330 cmd.u.flash_data_info.numbytes = cpu_to_le16(buf_size);
332 /* DT9812 only responds to 32 byte writes!! */
334 retval = usb_bulk_msg(dev->udev,
335 usb_sndbulkpipe(dev->udev,
336 dev->command_write.addr),
337 &cmd, 32, &count, HZ * 1);
340 retval = usb_bulk_msg(dev->udev,
341 usb_rcvbulkpipe(dev->udev,
342 dev->command_read.addr),
343 buf, buf_size, &count, HZ * 1);
347 static int dt9812_read_multiple_registers(struct usb_dt9812 *dev, int reg_count,
348 u8 *address, u8 *value)
350 struct dt9812_usb_cmd cmd;
351 int i, count, retval;
353 cmd.cmd = cpu_to_le32(DT9812_R_MULTI_BYTE_REG);
354 cmd.u.read_multi_info.count = reg_count;
355 for (i = 0; i < reg_count; i++)
356 cmd.u.read_multi_info.address[i] = address[i];
358 /* DT9812 only responds to 32 byte writes!! */
360 retval = usb_bulk_msg(dev->udev,
361 usb_sndbulkpipe(dev->udev,
362 dev->command_write.addr),
363 &cmd, 32, &count, HZ * 1);
366 retval = usb_bulk_msg(dev->udev,
367 usb_rcvbulkpipe(dev->udev,
368 dev->command_read.addr),
369 value, reg_count, &count, HZ * 1);
373 static int dt9812_write_multiple_registers(struct usb_dt9812 *dev,
374 int reg_count, u8 *address,
377 struct dt9812_usb_cmd cmd;
378 int i, count, retval;
380 cmd.cmd = cpu_to_le32(DT9812_W_MULTI_BYTE_REG);
381 cmd.u.read_multi_info.count = reg_count;
382 for (i = 0; i < reg_count; i++) {
383 cmd.u.write_multi_info.write[i].address = address[i];
384 cmd.u.write_multi_info.write[i].value = value[i];
386 /* DT9812 only responds to 32 byte writes!! */
387 retval = usb_bulk_msg(dev->udev,
388 usb_sndbulkpipe(dev->udev,
389 dev->command_write.addr),
390 &cmd, 32, &count, HZ * 1);
394 static int dt9812_rmw_multiple_registers(struct usb_dt9812 *dev, int reg_count,
395 struct dt9812_rmw_byte *rmw)
397 struct dt9812_usb_cmd cmd;
398 int i, count, retval;
400 cmd.cmd = cpu_to_le32(DT9812_RMW_MULTI_BYTE_REG);
401 cmd.u.rmw_multi_info.count = reg_count;
402 for (i = 0; i < reg_count; i++)
403 cmd.u.rmw_multi_info.rmw[i] = rmw[i];
405 /* DT9812 only responds to 32 byte writes!! */
406 retval = usb_bulk_msg(dev->udev,
407 usb_sndbulkpipe(dev->udev,
408 dev->command_write.addr),
409 &cmd, 32, &count, HZ * 1);
413 static int dt9812_digital_in(struct slot_dt9812 *slot, u8 *bits)
415 int result = -ENODEV;
419 u8 reg[2] = { F020_SFR_P3, F020_SFR_P1 };
422 result = dt9812_read_multiple_registers(slot->usb, 2, reg,
426 * bits 0-6 in F020_SFR_P3 are bits 0-6 in the digital
427 * input port bit 3 in F020_SFR_P1 is bit 7 in the
430 *bits = (value[0] & 0x7f) | ((value[1] & 0x08) << 4);
431 /* printk("%2.2x, %2.2x -> %2.2x\n",
432 value[0], value[1], *bits); */
440 static int dt9812_digital_out(struct slot_dt9812 *slot, u8 bits)
442 int result = -ENODEV;
449 reg[0] = F020_SFR_P2;
451 result = dt9812_write_multiple_registers(slot->usb, 1, reg,
453 slot->usb->digital_out_shadow = bits;
459 static int dt9812_digital_out_shadow(struct slot_dt9812 *slot, u8 *bits)
461 int result = -ENODEV;
465 *bits = slot->usb->digital_out_shadow;
472 static void dt9812_configure_mux(struct usb_dt9812 *dev,
473 struct dt9812_rmw_byte *rmw, int channel)
475 if (dev->device == DT9812_DEVID_DT9812_10) {
476 /* In the DT9812/10V MUX is selected by P1.5-7 */
477 rmw->address = F020_SFR_P1;
478 rmw->and_mask = 0xe0;
479 rmw->or_value = channel << 5;
481 /* In the DT9812/2.5V, internal mux is selected by bits 0:2 */
482 rmw->address = F020_SFR_AMX0SL;
483 rmw->and_mask = 0xff;
484 rmw->or_value = channel & 0x07;
488 static void dt9812_configure_gain(struct usb_dt9812 *dev,
489 struct dt9812_rmw_byte *rmw,
490 enum dt9812_gain gain)
492 if (dev->device == DT9812_DEVID_DT9812_10) {
493 /* In the DT9812/10V, there is an external gain of 0.5 */
497 rmw->address = F020_SFR_ADC0CF;
498 rmw->and_mask = F020_MASK_ADC0CF_AMP0GN2 |
499 F020_MASK_ADC0CF_AMP0GN1 | F020_MASK_ADC0CF_AMP0GN0;
509 case DT9812_GAIN_0PT5:
510 rmw->or_value = F020_MASK_ADC0CF_AMP0GN2 |
511 F020_MASK_ADC0CF_AMP0GN1;
514 rmw->or_value = 0x00;
517 rmw->or_value = F020_MASK_ADC0CF_AMP0GN0;
520 rmw->or_value = F020_MASK_ADC0CF_AMP0GN1;
523 rmw->or_value = F020_MASK_ADC0CF_AMP0GN1 |
524 F020_MASK_ADC0CF_AMP0GN0;
527 rmw->or_value = F020_MASK_ADC0CF_AMP0GN2;
530 dev_err(&dev->interface->dev, "Illegal gain %d\n", gain);
535 static int dt9812_analog_in(struct slot_dt9812 *slot, int channel, u16 *value,
536 enum dt9812_gain gain)
538 struct dt9812_rmw_byte rmw[3];
545 int result = -ENODEV;
551 /* 1 select the gain */
552 dt9812_configure_gain(slot->usb, &rmw[0], gain);
554 /* 2 set the MUX to select the channel */
555 dt9812_configure_mux(slot->usb, &rmw[1], channel);
557 /* 3 start conversion */
558 rmw[2].address = F020_SFR_ADC0CN;
559 rmw[2].and_mask = 0xff;
560 rmw[2].or_value = F020_MASK_ADC0CN_AD0EN | F020_MASK_ADC0CN_AD0BUSY;
562 result = dt9812_rmw_multiple_registers(slot->usb, 3, rmw);
566 /* read the status and ADC */
567 result = dt9812_read_multiple_registers(slot->usb, 3, reg, val);
571 * An ADC conversion takes 16 SAR clocks cycles, i.e. about 9us.
572 * Therefore, between the instant that AD0BUSY was set via
573 * dt9812_rmw_multiple_registers and the read of AD0BUSY via
574 * dt9812_read_multiple_registers, the conversion should be complete
575 * since these two operations require two USB transactions each taking
576 * at least a millisecond to complete. However, lets make sure that
577 * conversion is finished.
579 if ((val[0] & (F020_MASK_ADC0CN_AD0INT | F020_MASK_ADC0CN_AD0BUSY)) ==
580 F020_MASK_ADC0CN_AD0INT) {
581 switch (slot->usb->device) {
582 case DT9812_DEVID_DT9812_10:
584 * For DT9812-10V the personality module set the
585 * encoding to 2's complement. Hence, convert it before
588 *value = ((val[1] << 8) | val[2]) + 0x800;
590 case DT9812_DEVID_DT9812_2PT5:
591 *value = (val[1] << 8) | val[2];
601 static int dt9812_analog_out_shadow(struct slot_dt9812 *slot, int channel,
604 int result = -ENODEV;
608 *value = slot->usb->analog_out_shadow[channel];
616 static int dt9812_analog_out(struct slot_dt9812 *slot, int channel, u16 value)
618 int result = -ENODEV;
622 struct dt9812_rmw_byte rmw[3];
626 /* 1. Set DAC mode */
627 rmw[0].address = F020_SFR_DAC0CN;
628 rmw[0].and_mask = 0xff;
629 rmw[0].or_value = F020_MASK_DACxCN_DACxEN;
631 /* 2 load low byte of DAC value first */
632 rmw[1].address = F020_SFR_DAC0L;
633 rmw[1].and_mask = 0xff;
634 rmw[1].or_value = value & 0xff;
636 /* 3 load high byte of DAC value next to latch the
638 rmw[2].address = F020_SFR_DAC0H;
639 rmw[2].and_mask = 0xff;
640 rmw[2].or_value = (value >> 8) & 0xf;
644 /* 1. Set DAC mode */
645 rmw[0].address = F020_SFR_DAC1CN;
646 rmw[0].and_mask = 0xff;
647 rmw[0].or_value = F020_MASK_DACxCN_DACxEN;
649 /* 2 load low byte of DAC value first */
650 rmw[1].address = F020_SFR_DAC1L;
651 rmw[1].and_mask = 0xff;
652 rmw[1].or_value = value & 0xff;
654 /* 3 load high byte of DAC value next to latch the
656 rmw[2].address = F020_SFR_DAC1H;
657 rmw[2].and_mask = 0xff;
658 rmw[2].or_value = (value >> 8) & 0xf;
661 result = dt9812_rmw_multiple_registers(slot->usb, 3, rmw);
662 slot->usb->analog_out_shadow[channel] = value;
670 * USB framework functions
673 static int dt9812_probe(struct usb_interface *interface,
674 const struct usb_device_id *id)
676 int retval = -ENOMEM;
677 struct usb_dt9812 *dev = NULL;
678 struct usb_host_interface *iface_desc;
679 struct usb_endpoint_descriptor *endpoint;
683 /* allocate memory for our device state and initialize it */
684 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
688 kref_init(&dev->kref);
690 dev->udev = usb_get_dev(interface_to_usbdev(interface));
691 dev->interface = interface;
693 /* Check endpoints */
694 iface_desc = interface->cur_altsetting;
696 if (iface_desc->desc.bNumEndpoints != 5) {
697 dev_err(&interface->dev, "Wrong number of endpoints.\n");
702 for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
704 endpoint = &iface_desc->endpoint[i].desc;
707 direction = USB_DIR_IN;
708 dev->message_pipe.addr = endpoint->bEndpointAddress;
709 dev->message_pipe.size =
710 le16_to_cpu(endpoint->wMaxPacketSize);
714 direction = USB_DIR_OUT;
715 dev->command_write.addr = endpoint->bEndpointAddress;
716 dev->command_write.size =
717 le16_to_cpu(endpoint->wMaxPacketSize);
720 direction = USB_DIR_IN;
721 dev->command_read.addr = endpoint->bEndpointAddress;
722 dev->command_read.size =
723 le16_to_cpu(endpoint->wMaxPacketSize);
726 direction = USB_DIR_OUT;
727 dev->write_stream.addr = endpoint->bEndpointAddress;
728 dev->write_stream.size =
729 le16_to_cpu(endpoint->wMaxPacketSize);
732 direction = USB_DIR_IN;
733 dev->read_stream.addr = endpoint->bEndpointAddress;
734 dev->read_stream.size =
735 le16_to_cpu(endpoint->wMaxPacketSize);
738 if ((endpoint->bEndpointAddress & USB_DIR_IN) != direction) {
739 dev_err(&interface->dev,
740 "Endpoint has wrong direction.\n");
745 if (dt9812_read_info(dev, 0, &fw, sizeof(fw)) != 0) {
747 * Seems like a configuration reset is necessary if driver is
748 * reloaded while device is attached
750 usb_reset_configuration(dev->udev);
751 for (i = 0; i < 10; i++) {
752 retval = dt9812_read_info(dev, 1, &fw, sizeof(fw));
754 dev_info(&interface->dev,
755 "usb_reset_configuration succeeded "
756 "after %d iterations\n", i);
762 if (dt9812_read_info(dev, 1, &dev->vendor, sizeof(dev->vendor)) != 0) {
763 dev_err(&interface->dev, "Failed to read vendor.\n");
767 if (dt9812_read_info(dev, 3, &dev->product, sizeof(dev->product)) != 0) {
768 dev_err(&interface->dev, "Failed to read product.\n");
772 if (dt9812_read_info(dev, 5, &dev->device, sizeof(dev->device)) != 0) {
773 dev_err(&interface->dev, "Failed to read device.\n");
777 if (dt9812_read_info(dev, 7, &dev->serial, sizeof(dev->serial)) != 0) {
778 dev_err(&interface->dev, "Failed to read serial.\n");
783 dev->vendor = le16_to_cpu(dev->vendor);
784 dev->product = le16_to_cpu(dev->product);
785 dev->device = le16_to_cpu(dev->device);
786 dev->serial = le32_to_cpu(dev->serial);
787 switch (dev->device) {
788 case DT9812_DEVID_DT9812_10:
789 dev->analog_out_shadow[0] = 0x0800;
790 dev->analog_out_shadow[1] = 0x800;
792 case DT9812_DEVID_DT9812_2PT5:
793 dev->analog_out_shadow[0] = 0x0000;
794 dev->analog_out_shadow[1] = 0x0000;
797 dev->digital_out_shadow = 0;
799 /* save our data pointer in this interface device */
800 usb_set_intfdata(interface, dev);
802 /* let the user know what node this device is now attached to */
803 dev_info(&interface->dev, "USB DT9812 (%4.4x.%4.4x.%4.4x) #0x%8.8x\n",
804 dev->vendor, dev->product, dev->device, dev->serial);
808 /* Find a slot for the USB device */
809 struct slot_dt9812 *first = NULL;
810 struct slot_dt9812 *best = NULL;
812 for (i = 0; i < DT9812_NUM_SLOTS; i++) {
813 if (!first && !dt9812[i].usb && dt9812[i].serial == 0)
815 if (!best && dt9812[i].serial == dev->serial)
835 kref_put(&dev->kref, dt9812_delete);
839 static void dt9812_disconnect(struct usb_interface *interface)
841 struct usb_dt9812 *dev;
842 int minor = interface->minor;
845 dev = usb_get_intfdata(interface);
847 down(&dev->slot->mutex);
848 dev->slot->usb = NULL;
849 up(&dev->slot->mutex);
852 usb_set_intfdata(interface, NULL);
855 /* queue final destruction */
856 kref_put(&dev->kref, dt9812_delete);
858 dev_info(&interface->dev, "USB Dt9812 #%d now disconnected\n", minor);
861 static struct usb_driver dt9812_usb_driver = {
863 .probe = dt9812_probe,
864 .disconnect = dt9812_disconnect,
865 .id_table = dt9812_table,
872 static int dt9812_comedi_open(struct comedi_device *dev)
874 struct comedi_dt9812 *devpriv = dev->private;
875 int result = -ENODEV;
877 down(&devpriv->slot->mutex);
878 if (devpriv->slot->usb) {
879 /* We have an attached device, fill in current range info */
880 struct comedi_subdevice *s;
882 s = &dev->subdevices[0];
886 s = &dev->subdevices[1];
890 s = &dev->subdevices[2];
892 switch (devpriv->slot->usb->device) {
895 s->range_table = &range_bipolar10;
900 s->range_table = &range_unipolar2_5;
905 s = &dev->subdevices[3];
907 switch (devpriv->slot->usb->device) {
910 s->range_table = &range_bipolar10;
915 s->range_table = &range_unipolar2_5;
921 up(&devpriv->slot->mutex);
925 static int dt9812_di_rinsn(struct comedi_device *dev,
926 struct comedi_subdevice *s, struct comedi_insn *insn,
929 struct comedi_dt9812 *devpriv = dev->private;
930 unsigned int channel = CR_CHAN(insn->chanspec);
934 dt9812_digital_in(devpriv->slot, &bits);
935 for (n = 0; n < insn->n; n++)
936 data[n] = ((1 << channel) & bits) != 0;
940 static int dt9812_do_winsn(struct comedi_device *dev,
941 struct comedi_subdevice *s, struct comedi_insn *insn,
944 struct comedi_dt9812 *devpriv = dev->private;
945 unsigned int channel = CR_CHAN(insn->chanspec);
949 dt9812_digital_out_shadow(devpriv->slot, &bits);
950 for (n = 0; n < insn->n; n++) {
951 u8 mask = 1 << channel;
957 dt9812_digital_out(devpriv->slot, bits);
961 static int dt9812_ai_rinsn(struct comedi_device *dev,
962 struct comedi_subdevice *s, struct comedi_insn *insn,
965 struct comedi_dt9812 *devpriv = dev->private;
966 unsigned int channel = CR_CHAN(insn->chanspec);
969 for (n = 0; n < insn->n; n++) {
972 dt9812_analog_in(devpriv->slot, channel, &value, DT9812_GAIN_1);
978 static int dt9812_ao_rinsn(struct comedi_device *dev,
979 struct comedi_subdevice *s, struct comedi_insn *insn,
982 struct comedi_dt9812 *devpriv = dev->private;
983 unsigned int channel = CR_CHAN(insn->chanspec);
987 for (n = 0; n < insn->n; n++) {
989 dt9812_analog_out_shadow(devpriv->slot, channel, &value);
995 static int dt9812_ao_winsn(struct comedi_device *dev,
996 struct comedi_subdevice *s, struct comedi_insn *insn,
999 struct comedi_dt9812 *devpriv = dev->private;
1000 unsigned int channel = CR_CHAN(insn->chanspec);
1003 for (n = 0; n < insn->n; n++)
1004 dt9812_analog_out(devpriv->slot, channel, data[n]);
1008 static int dt9812_attach(struct comedi_device *dev, struct comedi_devconfig *it)
1010 struct comedi_dt9812 *devpriv;
1012 struct comedi_subdevice *s;
1015 devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
1018 dev->private = devpriv;
1021 * Special open routine, since USB unit may be unattached at
1022 * comedi_config time, hence range can not be determined
1024 dev->open = dt9812_comedi_open;
1026 devpriv->serial = it->options[0];
1028 ret = comedi_alloc_subdevices(dev, 4);
1032 /* digital input subdevice */
1033 s = &dev->subdevices[0];
1034 s->type = COMEDI_SUBD_DI;
1035 s->subdev_flags = SDF_READABLE;
1038 s->range_table = &range_digital;
1039 s->insn_read = &dt9812_di_rinsn;
1041 /* digital output subdevice */
1042 s = &dev->subdevices[1];
1043 s->type = COMEDI_SUBD_DO;
1044 s->subdev_flags = SDF_WRITEABLE;
1047 s->range_table = &range_digital;
1048 s->insn_write = &dt9812_do_winsn;
1050 /* analog input subdevice */
1051 s = &dev->subdevices[2];
1052 s->type = COMEDI_SUBD_AI;
1053 s->subdev_flags = SDF_READABLE | SDF_GROUND;
1056 s->range_table = NULL;
1057 s->insn_read = &dt9812_ai_rinsn;
1059 /* analog output subdevice */
1060 s = &dev->subdevices[3];
1061 s->type = COMEDI_SUBD_AO;
1062 s->subdev_flags = SDF_WRITEABLE;
1065 s->range_table = NULL;
1066 s->insn_write = &dt9812_ao_winsn;
1067 s->insn_read = &dt9812_ao_rinsn;
1069 dev_info(dev->class_dev, "successfully attached to dt9812.\n");
1071 down(&dt9812_mutex);
1072 /* Find a slot for the comedi device */
1074 struct slot_dt9812 *first = NULL;
1075 struct slot_dt9812 *best = NULL;
1076 for (i = 0; i < DT9812_NUM_SLOTS; i++) {
1077 if (!first && !dt9812[i].comedi) {
1078 /* First free slot from comedi side */
1083 dt9812[i].usb->serial == devpriv->serial) {
1084 /* We have an attaced device with matching ID */
1092 best->comedi = devpriv;
1093 best->serial = devpriv->serial;
1094 devpriv->slot = best;
1103 static void dt9812_detach(struct comedi_device *dev)
1105 /* Nothing to cleanup */
1108 static struct comedi_driver dt9812_comedi_driver = {
1109 .module = THIS_MODULE,
1110 .driver_name = "dt9812",
1111 .attach = dt9812_attach,
1112 .detach = dt9812_detach,
1115 static int __init usb_dt9812_init(void)
1119 /* Initialize all driver slots */
1120 for (i = 0; i < DT9812_NUM_SLOTS; i++) {
1121 sema_init(&dt9812[i].mutex, 1);
1122 dt9812[i].serial = 0;
1123 dt9812[i].usb = NULL;
1124 dt9812[i].comedi = NULL;
1126 dt9812[12].serial = 0x0;
1128 return comedi_usb_driver_register(&dt9812_comedi_driver,
1129 &dt9812_usb_driver);
1132 static void __exit usb_dt9812_exit(void)
1134 comedi_usb_driver_unregister(&dt9812_comedi_driver, &dt9812_usb_driver);
1137 module_init(usb_dt9812_init);
1138 module_exit(usb_dt9812_exit);
1140 MODULE_AUTHOR("Anders Blomdell <anders.blomdell@control.lth.se>");
1141 MODULE_DESCRIPTION("Comedi DT9812 driver");
1142 MODULE_LICENSE("GPL");