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 const struct comedi_lrange dt9812_10_ain_range
= { 1, {
311 static const struct comedi_lrange dt9812_2pt5_ain_range
= { 1, {
316 static const struct comedi_lrange dt9812_10_aout_range
= { 1, {
321 static const struct comedi_lrange dt9812_2pt5_aout_range
= { 1, {
326 static struct slot_dt9812 dt9812
[DT9812_NUM_SLOTS
];
328 static inline struct usb_dt9812
*to_dt9812_dev(struct kref
*d
)
330 return container_of(d
, struct usb_dt9812
, kref
);
333 static void dt9812_delete(struct kref
*kref
)
335 struct usb_dt9812
*dev
= to_dt9812_dev(kref
);
337 usb_put_dev(dev
->udev
);
341 static int dt9812_read_info(struct usb_dt9812
*dev
, int offset
, void *buf
,
344 struct dt9812_usb_cmd cmd
;
347 cmd
.cmd
= cpu_to_le32(DT9812_R_FLASH_DATA
);
348 cmd
.u
.flash_data_info
.address
=
349 cpu_to_le16(DT9812_DIAGS_BOARD_INFO_ADDR
+ offset
);
350 cmd
.u
.flash_data_info
.numbytes
= cpu_to_le16(buf_size
);
352 /* DT9812 only responds to 32 byte writes!! */
354 retval
= usb_bulk_msg(dev
->udev
,
355 usb_sndbulkpipe(dev
->udev
,
356 dev
->command_write
.addr
),
357 &cmd
, 32, &count
, HZ
* 1);
360 retval
= usb_bulk_msg(dev
->udev
,
361 usb_rcvbulkpipe(dev
->udev
,
362 dev
->command_read
.addr
),
363 buf
, buf_size
, &count
, HZ
* 1);
367 static int dt9812_read_multiple_registers(struct usb_dt9812
*dev
, int reg_count
,
368 u8
*address
, u8
*value
)
370 struct dt9812_usb_cmd cmd
;
371 int i
, count
, retval
;
373 cmd
.cmd
= cpu_to_le32(DT9812_R_MULTI_BYTE_REG
);
374 cmd
.u
.read_multi_info
.count
= reg_count
;
375 for (i
= 0; i
< reg_count
; i
++)
376 cmd
.u
.read_multi_info
.address
[i
] = address
[i
];
378 /* DT9812 only responds to 32 byte writes!! */
380 retval
= usb_bulk_msg(dev
->udev
,
381 usb_sndbulkpipe(dev
->udev
,
382 dev
->command_write
.addr
),
383 &cmd
, 32, &count
, HZ
* 1);
386 retval
= usb_bulk_msg(dev
->udev
,
387 usb_rcvbulkpipe(dev
->udev
,
388 dev
->command_read
.addr
),
389 value
, reg_count
, &count
, HZ
* 1);
393 static int dt9812_write_multiple_registers(struct usb_dt9812
*dev
,
394 int reg_count
, u8
*address
,
397 struct dt9812_usb_cmd cmd
;
398 int i
, count
, retval
;
400 cmd
.cmd
= cpu_to_le32(DT9812_W_MULTI_BYTE_REG
);
401 cmd
.u
.read_multi_info
.count
= reg_count
;
402 for (i
= 0; i
< reg_count
; i
++) {
403 cmd
.u
.write_multi_info
.write
[i
].address
= address
[i
];
404 cmd
.u
.write_multi_info
.write
[i
].value
= value
[i
];
406 /* DT9812 only responds to 32 byte writes!! */
407 retval
= usb_bulk_msg(dev
->udev
,
408 usb_sndbulkpipe(dev
->udev
,
409 dev
->command_write
.addr
),
410 &cmd
, 32, &count
, HZ
* 1);
414 static int dt9812_rmw_multiple_registers(struct usb_dt9812
*dev
, int reg_count
,
415 struct dt9812_rmw_byte
*rmw
)
417 struct dt9812_usb_cmd cmd
;
418 int i
, count
, retval
;
420 cmd
.cmd
= cpu_to_le32(DT9812_RMW_MULTI_BYTE_REG
);
421 cmd
.u
.rmw_multi_info
.count
= reg_count
;
422 for (i
= 0; i
< reg_count
; i
++)
423 cmd
.u
.rmw_multi_info
.rmw
[i
] = rmw
[i
];
425 /* DT9812 only responds to 32 byte writes!! */
426 retval
= usb_bulk_msg(dev
->udev
,
427 usb_sndbulkpipe(dev
->udev
,
428 dev
->command_write
.addr
),
429 &cmd
, 32, &count
, HZ
* 1);
433 static int dt9812_digital_in(struct slot_dt9812
*slot
, u8
*bits
)
435 int result
= -ENODEV
;
439 u8 reg
[2] = { F020_SFR_P3
, F020_SFR_P1
};
442 result
= dt9812_read_multiple_registers(slot
->usb
, 2, reg
,
446 * bits 0-6 in F020_SFR_P3 are bits 0-6 in the digital
447 * input port bit 3 in F020_SFR_P1 is bit 7 in the
450 *bits
= (value
[0] & 0x7f) | ((value
[1] & 0x08) << 4);
451 /* printk("%2.2x, %2.2x -> %2.2x\n",
452 value[0], value[1], *bits); */
460 static int dt9812_digital_out(struct slot_dt9812
*slot
, u8 bits
)
462 int result
= -ENODEV
;
469 reg
[0] = F020_SFR_P2
;
471 result
= dt9812_write_multiple_registers(slot
->usb
, 1, reg
,
473 slot
->usb
->digital_out_shadow
= bits
;
479 static int dt9812_digital_out_shadow(struct slot_dt9812
*slot
, u8
*bits
)
481 int result
= -ENODEV
;
485 *bits
= slot
->usb
->digital_out_shadow
;
492 static void dt9812_configure_mux(struct usb_dt9812
*dev
,
493 struct dt9812_rmw_byte
*rmw
, int channel
)
495 if (dev
->device
== DT9812_DEVID_DT9812_10
) {
496 /* In the DT9812/10V MUX is selected by P1.5-7 */
497 rmw
->address
= F020_SFR_P1
;
498 rmw
->and_mask
= 0xe0;
499 rmw
->or_value
= channel
<< 5;
501 /* In the DT9812/2.5V, internal mux is selected by bits 0:2 */
502 rmw
->address
= F020_SFR_AMX0SL
;
503 rmw
->and_mask
= 0xff;
504 rmw
->or_value
= channel
& 0x07;
508 static void dt9812_configure_gain(struct usb_dt9812
*dev
,
509 struct dt9812_rmw_byte
*rmw
,
510 enum dt9812_gain gain
)
512 if (dev
->device
== DT9812_DEVID_DT9812_10
) {
513 /* In the DT9812/10V, there is an external gain of 0.5 */
517 rmw
->address
= F020_SFR_ADC0CF
;
518 rmw
->and_mask
= F020_MASK_ADC0CF_AMP0GN2
|
519 F020_MASK_ADC0CF_AMP0GN1
| F020_MASK_ADC0CF_AMP0GN0
;
529 case DT9812_GAIN_0PT5
:
530 rmw
->or_value
= F020_MASK_ADC0CF_AMP0GN2
|
531 F020_MASK_ADC0CF_AMP0GN1
;
534 rmw
->or_value
= 0x00;
537 rmw
->or_value
= F020_MASK_ADC0CF_AMP0GN0
;
540 rmw
->or_value
= F020_MASK_ADC0CF_AMP0GN1
;
543 rmw
->or_value
= F020_MASK_ADC0CF_AMP0GN1
|
544 F020_MASK_ADC0CF_AMP0GN0
;
547 rmw
->or_value
= F020_MASK_ADC0CF_AMP0GN2
;
550 dev_err(&dev
->interface
->dev
, "Illegal gain %d\n", gain
);
555 static int dt9812_analog_in(struct slot_dt9812
*slot
, int channel
, u16
*value
,
556 enum dt9812_gain gain
)
558 struct dt9812_rmw_byte rmw
[3];
565 int result
= -ENODEV
;
571 /* 1 select the gain */
572 dt9812_configure_gain(slot
->usb
, &rmw
[0], gain
);
574 /* 2 set the MUX to select the channel */
575 dt9812_configure_mux(slot
->usb
, &rmw
[1], channel
);
577 /* 3 start conversion */
578 rmw
[2].address
= F020_SFR_ADC0CN
;
579 rmw
[2].and_mask
= 0xff;
580 rmw
[2].or_value
= F020_MASK_ADC0CN_AD0EN
| F020_MASK_ADC0CN_AD0BUSY
;
582 result
= dt9812_rmw_multiple_registers(slot
->usb
, 3, rmw
);
586 /* read the status and ADC */
587 result
= dt9812_read_multiple_registers(slot
->usb
, 3, reg
, val
);
591 * An ADC conversion takes 16 SAR clocks cycles, i.e. about 9us.
592 * Therefore, between the instant that AD0BUSY was set via
593 * dt9812_rmw_multiple_registers and the read of AD0BUSY via
594 * dt9812_read_multiple_registers, the conversion should be complete
595 * since these two operations require two USB transactions each taking
596 * at least a millisecond to complete. However, lets make sure that
597 * conversion is finished.
599 if ((val
[0] & (F020_MASK_ADC0CN_AD0INT
| F020_MASK_ADC0CN_AD0BUSY
)) ==
600 F020_MASK_ADC0CN_AD0INT
) {
601 switch (slot
->usb
->device
) {
602 case DT9812_DEVID_DT9812_10
:
604 * For DT9812-10V the personality module set the
605 * encoding to 2's complement. Hence, convert it before
608 *value
= ((val
[1] << 8) | val
[2]) + 0x800;
610 case DT9812_DEVID_DT9812_2PT5
:
611 *value
= (val
[1] << 8) | val
[2];
621 static int dt9812_analog_out_shadow(struct slot_dt9812
*slot
, int channel
,
624 int result
= -ENODEV
;
628 *value
= slot
->usb
->analog_out_shadow
[channel
];
636 static int dt9812_analog_out(struct slot_dt9812
*slot
, int channel
, u16 value
)
638 int result
= -ENODEV
;
642 struct dt9812_rmw_byte rmw
[3];
646 /* 1. Set DAC mode */
647 rmw
[0].address
= F020_SFR_DAC0CN
;
648 rmw
[0].and_mask
= 0xff;
649 rmw
[0].or_value
= F020_MASK_DACxCN_DACxEN
;
651 /* 2 load low byte of DAC value first */
652 rmw
[1].address
= F020_SFR_DAC0L
;
653 rmw
[1].and_mask
= 0xff;
654 rmw
[1].or_value
= value
& 0xff;
656 /* 3 load high byte of DAC value next to latch the
658 rmw
[2].address
= F020_SFR_DAC0H
;
659 rmw
[2].and_mask
= 0xff;
660 rmw
[2].or_value
= (value
>> 8) & 0xf;
664 /* 1. Set DAC mode */
665 rmw
[0].address
= F020_SFR_DAC1CN
;
666 rmw
[0].and_mask
= 0xff;
667 rmw
[0].or_value
= F020_MASK_DACxCN_DACxEN
;
669 /* 2 load low byte of DAC value first */
670 rmw
[1].address
= F020_SFR_DAC1L
;
671 rmw
[1].and_mask
= 0xff;
672 rmw
[1].or_value
= value
& 0xff;
674 /* 3 load high byte of DAC value next to latch the
676 rmw
[2].address
= F020_SFR_DAC1H
;
677 rmw
[2].and_mask
= 0xff;
678 rmw
[2].or_value
= (value
>> 8) & 0xf;
681 result
= dt9812_rmw_multiple_registers(slot
->usb
, 3, rmw
);
682 slot
->usb
->analog_out_shadow
[channel
] = value
;
690 * USB framework functions
693 static int dt9812_probe(struct usb_interface
*interface
,
694 const struct usb_device_id
*id
)
696 int retval
= -ENOMEM
;
697 struct usb_dt9812
*dev
= NULL
;
698 struct usb_host_interface
*iface_desc
;
699 struct usb_endpoint_descriptor
*endpoint
;
703 /* allocate memory for our device state and initialize it */
704 dev
= kzalloc(sizeof(*dev
), GFP_KERNEL
);
706 dev_err(&interface
->dev
, "Out of memory\n");
709 kref_init(&dev
->kref
);
711 dev
->udev
= usb_get_dev(interface_to_usbdev(interface
));
712 dev
->interface
= interface
;
714 /* Check endpoints */
715 iface_desc
= interface
->cur_altsetting
;
717 if (iface_desc
->desc
.bNumEndpoints
!= 5) {
718 dev_err(&interface
->dev
, "Wrong number of endpoints.\n");
723 for (i
= 0; i
< iface_desc
->desc
.bNumEndpoints
; ++i
) {
725 endpoint
= &iface_desc
->endpoint
[i
].desc
;
728 direction
= USB_DIR_IN
;
729 dev
->message_pipe
.addr
= endpoint
->bEndpointAddress
;
730 dev
->message_pipe
.size
=
731 le16_to_cpu(endpoint
->wMaxPacketSize
);
735 direction
= USB_DIR_OUT
;
736 dev
->command_write
.addr
= endpoint
->bEndpointAddress
;
737 dev
->command_write
.size
=
738 le16_to_cpu(endpoint
->wMaxPacketSize
);
741 direction
= USB_DIR_IN
;
742 dev
->command_read
.addr
= endpoint
->bEndpointAddress
;
743 dev
->command_read
.size
=
744 le16_to_cpu(endpoint
->wMaxPacketSize
);
747 direction
= USB_DIR_OUT
;
748 dev
->write_stream
.addr
= endpoint
->bEndpointAddress
;
749 dev
->write_stream
.size
=
750 le16_to_cpu(endpoint
->wMaxPacketSize
);
753 direction
= USB_DIR_IN
;
754 dev
->read_stream
.addr
= endpoint
->bEndpointAddress
;
755 dev
->read_stream
.size
=
756 le16_to_cpu(endpoint
->wMaxPacketSize
);
759 if ((endpoint
->bEndpointAddress
& USB_DIR_IN
) != direction
) {
760 dev_err(&interface
->dev
,
761 "Endpoint has wrong direction.\n");
766 if (dt9812_read_info(dev
, 0, &fw
, sizeof(fw
)) != 0) {
768 * Seems like a configuration reset is necessary if driver is
769 * reloaded while device is attached
771 usb_reset_configuration(dev
->udev
);
772 for (i
= 0; i
< 10; i
++) {
773 retval
= dt9812_read_info(dev
, 1, &fw
, sizeof(fw
));
775 dev_info(&interface
->dev
,
776 "usb_reset_configuration succeeded "
777 "after %d iterations\n", i
);
783 if (dt9812_read_info(dev
, 1, &dev
->vendor
, sizeof(dev
->vendor
)) != 0) {
784 dev_err(&interface
->dev
, "Failed to read vendor.\n");
788 if (dt9812_read_info(dev
, 3, &dev
->product
, sizeof(dev
->product
)) != 0) {
789 dev_err(&interface
->dev
, "Failed to read product.\n");
793 if (dt9812_read_info(dev
, 5, &dev
->device
, sizeof(dev
->device
)) != 0) {
794 dev_err(&interface
->dev
, "Failed to read device.\n");
798 if (dt9812_read_info(dev
, 7, &dev
->serial
, sizeof(dev
->serial
)) != 0) {
799 dev_err(&interface
->dev
, "Failed to read serial.\n");
804 dev
->vendor
= le16_to_cpu(dev
->vendor
);
805 dev
->product
= le16_to_cpu(dev
->product
);
806 dev
->device
= le16_to_cpu(dev
->device
);
807 dev
->serial
= le32_to_cpu(dev
->serial
);
808 switch (dev
->device
) {
809 case DT9812_DEVID_DT9812_10
:
810 dev
->analog_out_shadow
[0] = 0x0800;
811 dev
->analog_out_shadow
[1] = 0x800;
813 case DT9812_DEVID_DT9812_2PT5
:
814 dev
->analog_out_shadow
[0] = 0x0000;
815 dev
->analog_out_shadow
[1] = 0x0000;
818 dev
->digital_out_shadow
= 0;
820 /* save our data pointer in this interface device */
821 usb_set_intfdata(interface
, dev
);
823 /* let the user know what node this device is now attached to */
824 dev_info(&interface
->dev
, "USB DT9812 (%4.4x.%4.4x.%4.4x) #0x%8.8x\n",
825 dev
->vendor
, dev
->product
, dev
->device
, dev
->serial
);
829 /* Find a slot for the USB device */
830 struct slot_dt9812
*first
= NULL
;
831 struct slot_dt9812
*best
= NULL
;
833 for (i
= 0; i
< DT9812_NUM_SLOTS
; i
++) {
834 if (!first
&& !dt9812
[i
].usb
&& dt9812
[i
].serial
== 0)
836 if (!best
&& dt9812
[i
].serial
== dev
->serial
)
856 kref_put(&dev
->kref
, dt9812_delete
);
860 static void dt9812_disconnect(struct usb_interface
*interface
)
862 struct usb_dt9812
*dev
;
863 int minor
= interface
->minor
;
866 dev
= usb_get_intfdata(interface
);
868 down(&dev
->slot
->mutex
);
869 dev
->slot
->usb
= NULL
;
870 up(&dev
->slot
->mutex
);
873 usb_set_intfdata(interface
, NULL
);
876 /* queue final destruction */
877 kref_put(&dev
->kref
, dt9812_delete
);
879 dev_info(&interface
->dev
, "USB Dt9812 #%d now disconnected\n", minor
);
882 static struct usb_driver dt9812_usb_driver
= {
884 .probe
= dt9812_probe
,
885 .disconnect
= dt9812_disconnect
,
886 .id_table
= dt9812_table
,
893 static int dt9812_comedi_open(struct comedi_device
*dev
)
895 struct comedi_dt9812
*devpriv
= dev
->private;
896 int result
= -ENODEV
;
898 down(&devpriv
->slot
->mutex
);
899 if (devpriv
->slot
->usb
) {
900 /* We have an attached device, fill in current range info */
901 struct comedi_subdevice
*s
;
903 s
= &dev
->subdevices
[0];
907 s
= &dev
->subdevices
[1];
911 s
= &dev
->subdevices
[2];
913 switch (devpriv
->slot
->usb
->device
) {
916 s
->range_table
= &dt9812_10_ain_range
;
921 s
->range_table
= &dt9812_2pt5_ain_range
;
926 s
= &dev
->subdevices
[3];
928 switch (devpriv
->slot
->usb
->device
) {
931 s
->range_table
= &dt9812_10_aout_range
;
936 s
->range_table
= &dt9812_2pt5_aout_range
;
942 up(&devpriv
->slot
->mutex
);
946 static int dt9812_di_rinsn(struct comedi_device
*dev
,
947 struct comedi_subdevice
*s
, struct comedi_insn
*insn
,
950 struct comedi_dt9812
*devpriv
= dev
->private;
954 dt9812_digital_in(devpriv
->slot
, &bits
);
955 for (n
= 0; n
< insn
->n
; n
++)
956 data
[n
] = ((1 << insn
->chanspec
) & bits
) != 0;
960 static int dt9812_do_winsn(struct comedi_device
*dev
,
961 struct comedi_subdevice
*s
, struct comedi_insn
*insn
,
964 struct comedi_dt9812
*devpriv
= dev
->private;
968 dt9812_digital_out_shadow(devpriv
->slot
, &bits
);
969 for (n
= 0; n
< insn
->n
; n
++) {
970 u8 mask
= 1 << insn
->chanspec
;
976 dt9812_digital_out(devpriv
->slot
, bits
);
980 static int dt9812_ai_rinsn(struct comedi_device
*dev
,
981 struct comedi_subdevice
*s
, struct comedi_insn
*insn
,
984 struct comedi_dt9812
*devpriv
= dev
->private;
987 for (n
= 0; n
< insn
->n
; n
++) {
990 dt9812_analog_in(devpriv
->slot
, insn
->chanspec
, &value
,
997 static int dt9812_ao_rinsn(struct comedi_device
*dev
,
998 struct comedi_subdevice
*s
, struct comedi_insn
*insn
,
1001 struct comedi_dt9812
*devpriv
= dev
->private;
1005 for (n
= 0; n
< insn
->n
; n
++) {
1007 dt9812_analog_out_shadow(devpriv
->slot
, insn
->chanspec
, &value
);
1013 static int dt9812_ao_winsn(struct comedi_device
*dev
,
1014 struct comedi_subdevice
*s
, struct comedi_insn
*insn
,
1017 struct comedi_dt9812
*devpriv
= dev
->private;
1020 for (n
= 0; n
< insn
->n
; n
++)
1021 dt9812_analog_out(devpriv
->slot
, insn
->chanspec
, data
[n
]);
1025 static int dt9812_attach(struct comedi_device
*dev
, struct comedi_devconfig
*it
)
1027 struct comedi_dt9812
*devpriv
;
1029 struct comedi_subdevice
*s
;
1032 dev
->board_name
= "dt9812";
1034 devpriv
= kzalloc(sizeof(*devpriv
), GFP_KERNEL
);
1037 dev
->private = devpriv
;
1040 * Special open routine, since USB unit may be unattached at
1041 * comedi_config time, hence range can not be determined
1043 dev
->open
= dt9812_comedi_open
;
1045 devpriv
->serial
= it
->options
[0];
1047 ret
= comedi_alloc_subdevices(dev
, 4);
1051 /* digital input subdevice */
1052 s
= &dev
->subdevices
[0];
1053 s
->type
= COMEDI_SUBD_DI
;
1054 s
->subdev_flags
= SDF_READABLE
;
1057 s
->range_table
= &range_digital
;
1058 s
->insn_read
= &dt9812_di_rinsn
;
1060 /* digital output subdevice */
1061 s
= &dev
->subdevices
[1];
1062 s
->type
= COMEDI_SUBD_DO
;
1063 s
->subdev_flags
= SDF_WRITEABLE
;
1066 s
->range_table
= &range_digital
;
1067 s
->insn_write
= &dt9812_do_winsn
;
1069 /* analog input subdevice */
1070 s
= &dev
->subdevices
[2];
1071 s
->type
= COMEDI_SUBD_AI
;
1072 s
->subdev_flags
= SDF_READABLE
| SDF_GROUND
;
1075 s
->range_table
= NULL
;
1076 s
->insn_read
= &dt9812_ai_rinsn
;
1078 /* analog output subdevice */
1079 s
= &dev
->subdevices
[3];
1080 s
->type
= COMEDI_SUBD_AO
;
1081 s
->subdev_flags
= SDF_WRITEABLE
;
1084 s
->range_table
= NULL
;
1085 s
->insn_write
= &dt9812_ao_winsn
;
1086 s
->insn_read
= &dt9812_ao_rinsn
;
1088 dev_info(dev
->class_dev
, "successfully attached to dt9812.\n");
1090 down(&dt9812_mutex
);
1091 /* Find a slot for the comedi device */
1093 struct slot_dt9812
*first
= NULL
;
1094 struct slot_dt9812
*best
= NULL
;
1095 for (i
= 0; i
< DT9812_NUM_SLOTS
; i
++) {
1096 if (!first
&& !dt9812
[i
].comedi
) {
1097 /* First free slot from comedi side */
1102 dt9812
[i
].usb
->serial
== devpriv
->serial
) {
1103 /* We have an attaced device with matching ID */
1111 best
->comedi
= devpriv
;
1112 best
->serial
= devpriv
->serial
;
1113 devpriv
->slot
= best
;
1122 static void dt9812_detach(struct comedi_device
*dev
)
1124 /* Nothing to cleanup */
1127 static struct comedi_driver dt9812_comedi_driver
= {
1128 .module
= THIS_MODULE
,
1129 .driver_name
= "dt9812",
1130 .attach
= dt9812_attach
,
1131 .detach
= dt9812_detach
,
1134 static int __init
usb_dt9812_init(void)
1138 /* Initialize all driver slots */
1139 for (i
= 0; i
< DT9812_NUM_SLOTS
; i
++) {
1140 sema_init(&dt9812
[i
].mutex
, 1);
1141 dt9812
[i
].serial
= 0;
1142 dt9812
[i
].usb
= NULL
;
1143 dt9812
[i
].comedi
= NULL
;
1145 dt9812
[12].serial
= 0x0;
1147 /* register with the USB subsystem */
1148 result
= usb_register(&dt9812_usb_driver
);
1150 pr_err("usb_register failed. Error number %d\n", result
);
1153 /* register with comedi */
1154 result
= comedi_driver_register(&dt9812_comedi_driver
);
1156 usb_deregister(&dt9812_usb_driver
);
1157 pr_err("comedi_driver_register failed. Error number %d\n",
1164 static void __exit
usb_dt9812_exit(void)
1166 /* unregister with comedi */
1167 comedi_driver_unregister(&dt9812_comedi_driver
);
1169 /* deregister this driver with the USB subsystem */
1170 usb_deregister(&dt9812_usb_driver
);
1173 module_init(usb_dt9812_init
);
1174 module_exit(usb_dt9812_exit
);
1176 MODULE_AUTHOR("Anders Blomdell <anders.blomdell@control.lth.se>");
1177 MODULE_DESCRIPTION("Comedi DT9812 driver");
1178 MODULE_LICENSE("GPL");