Merge branch 'devel' of git://git.kernel.org/pub/scm/linux/kernel/git/ycmiao/pxa...
[linux-2.6] / drivers / staging / comedi / drivers / usbdux.c
1 #define DRIVER_VERSION "v2.2"
2 #define DRIVER_AUTHOR "Bernd Porr, BerndPorr@f2s.com"
3 #define DRIVER_DESC "Stirling/ITL USB-DUX -- Bernd.Porr@f2s.com"
4 /*
5    comedi/drivers/usbdux.c
6    Copyright (C) 2003-2007 Bernd Porr, Bernd.Porr@f2s.com
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
18    You should have received a copy of the GNU General Public License
19    along with this program; if not, write to the Free Software
20    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21
22  */
23 /*
24 Driver: usbdux
25 Description: University of Stirling USB DAQ & INCITE Technology Limited
26 Devices: [ITL] USB-DUX (usbdux.o)
27 Author: Bernd Porr <BerndPorr@f2s.com>
28 Updated: 8 Dec 2008
29 Status: Stable
30 Configuration options:
31   You have to upload firmware with the -i option. The
32   firmware is usually installed under /usr/share/usb or
33   /usr/local/share/usb or /lib/firmware.
34
35 Connection scheme for the counter at the digital port:
36   0=/CLK0, 1=UP/DOWN0, 2=RESET0, 4=/CLK1, 5=UP/DOWN1, 6=RESET1.
37   The sampling rate of the counter is approximately 500Hz.
38
39 Please note that under USB2.0 the length of the channel list determines
40 the max sampling rate. If you sample only one channel you get 8kHz
41 sampling rate. If you sample two channels you get 4kHz and so on.
42 */
43 /*
44  * I must give credit here to Chris Baugher who
45  * wrote the driver for AT-MIO-16d. I used some parts of this
46  * driver. I also must give credits to David Brownell
47  * who supported me with the USB development.
48  *
49  * Bernd Porr
50  *
51  *
52  * Revision history:
53  * 0.94: D/A output should work now with any channel list combinations
54  * 0.95: .owner commented out for kernel vers below 2.4.19
55  *       sanity checks in ai/ao_cmd
56  * 0.96: trying to get it working with 2.6, moved all memory alloc to comedi's
57  *       attach final USB IDs
58  *       moved memory allocation completely to the corresponding comedi
59  *       functions firmware upload is by fxload and no longer by comedi (due to
60  *       enumeration)
61  * 0.97: USB IDs received, adjusted table
62  * 0.98: SMP, locking, memroy alloc: moved all usb memory alloc
63  *       to the usb subsystem and moved all comedi related memory
64  *       alloc to comedi.
65  *       | kernel | registration | usbdux-usb | usbdux-comedi | comedi |
66  * 0.99: USB 2.0: changed protocol to isochronous transfer
67  *                IRQ transfer is too buggy and too risky in 2.0
68  *                for the high speed ISO transfer is now a working version
69  *                available
70  * 0.99b: Increased the iso transfer buffer for high sp.to 10 buffers. Some VIA
71  *        chipsets miss out IRQs. Deeper buffering is needed.
72  * 1.00: full USB 2.0 support for the A/D converter. Now: max 8kHz sampling
73  *       rate.
74  *       Firmware vers 1.00 is needed for this.
75  *       Two 16 bit up/down/reset counter with a sampling rate of 1kHz
76  *       And loads of cleaning up, in particular streamlining the
77  *       bulk transfers.
78  * 1.1:  moved EP4 transfers to EP1 to make space for a PWM output on EP4
79  * 1.2:  added PWM suport via EP4
80  * 2.0:  PWM seems to be stable and is not interfering with the other functions
81  * 2.1:  changed PWM API
82  * 2.2:  added firmware kernel request to fix an udev problem
83  *
84  */
85
86 /* generates loads of debug info */
87 /* #define NOISY_DUX_DEBUGBUG */
88
89 #include <linux/kernel.h>
90 #include <linux/module.h>
91 #include <linux/init.h>
92 #include <linux/slab.h>
93 #include <linux/input.h>
94 #include <linux/usb.h>
95 #include <linux/smp_lock.h>
96 #include <linux/fcntl.h>
97 #include <linux/compiler.h>
98 #include <linux/firmware.h>
99
100 #include "../comedidev.h"
101
102 #define BOARDNAME "usbdux"
103
104 /* timeout for the USB-transfer */
105 #define EZTIMEOUT 30
106
107 /* constants for "firmware" upload and download */
108 #define USBDUXSUB_FIRMWARE 0xA0
109 #define VENDOR_DIR_IN  0xC0
110 #define VENDOR_DIR_OUT 0x40
111
112 /* internal adresses of the 8051 processor */
113 #define USBDUXSUB_CPUCS 0xE600
114
115 /*
116  * the minor device number, major is 180 only for debugging purposes and to
117  * upload special firmware (programming the eeprom etc) which is not compatible
118  * with the comedi framwork
119  */
120 #define USBDUXSUB_MINOR 32
121
122 /* max lenghth of the transfer-buffer for software upload */
123 #define TB_LEN 0x2000
124
125 /* Input endpoint number: ISO/IRQ */
126 #define ISOINEP           6
127
128 /* Output endpoint number: ISO/IRQ */
129 #define ISOOUTEP          2
130
131 /* This EP sends DUX commands to USBDUX */
132 #define COMMAND_OUT_EP     1
133
134 /* This EP receives the DUX commands from USBDUX */
135 #define COMMAND_IN_EP        8
136
137 /* Output endpoint for PWM */
138 #define PWM_EP         4
139
140 /* 300Hz max frequ under PWM */
141 #define MIN_PWM_PERIOD  ((long)(1E9/300))
142
143 /* Default PWM frequency */
144 #define PWM_DEFAULT_PERIOD ((long)(1E9/100))
145
146 /* Number of channels */
147 #define NUMCHANNELS       8
148
149 /* Size of one A/D value */
150 #define SIZEADIN          ((sizeof(int16_t)))
151
152 /*
153  * Size of the input-buffer IN BYTES
154  * Always multiple of 8 for 8 microframes which is needed in the highspeed mode
155  */
156 #define SIZEINBUF         ((8*SIZEADIN))
157
158 /* 16 bytes. */
159 #define SIZEINSNBUF       16
160
161 /* Number of DA channels */
162 #define NUMOUTCHANNELS    8
163
164 /* size of one value for the D/A converter: channel and value */
165 #define SIZEDAOUT          ((sizeof(int8_t)+sizeof(int16_t)))
166
167 /*
168  * Size of the output-buffer in bytes
169  * Actually only the first 4 triplets are used but for the
170  * high speed mode we need to pad it to 8 (microframes).
171  */
172 #define SIZEOUTBUF         ((8*SIZEDAOUT))
173
174 /*
175  * Size of the buffer for the dux commands: just now max size is determined
176  * by the analogue out + command byte + panic bytes...
177  */
178 #define SIZEOFDUXBUFFER    ((8*SIZEDAOUT+2))
179
180 /* Number of in-URBs which receive the data: min=2 */
181 #define NUMOFINBUFFERSFULL     5
182
183 /* Number of out-URBs which send the data: min=2 */
184 #define NUMOFOUTBUFFERSFULL    5
185
186 /* Number of in-URBs which receive the data: min=5 */
187 /* must have more buffers due to buggy USB ctr */
188 #define NUMOFINBUFFERSHIGH     10
189
190 /* Number of out-URBs which send the data: min=5 */
191 /* must have more buffers due to buggy USB ctr */
192 #define NUMOFOUTBUFFERSHIGH    10
193
194 /* Total number of usbdux devices */
195 #define NUMUSBDUX             16
196
197 /* Analogue in subdevice */
198 #define SUBDEV_AD             0
199
200 /* Analogue out subdevice */
201 #define SUBDEV_DA             1
202
203 /* Digital I/O */
204 #define SUBDEV_DIO            2
205
206 /* counter */
207 #define SUBDEV_COUNTER        3
208
209 /* timer aka pwm output */
210 #define SUBDEV_PWM            4
211
212 /* number of retries to get the right dux command */
213 #define RETRIES 10
214
215 /**************************************************/
216 /* comedi constants */
217 static const struct comedi_lrange range_usbdux_ai_range = { 4, {
218                         BIP_RANGE(4.096),
219                         BIP_RANGE(4.096 / 2),
220                         UNI_RANGE(4.096),
221                         UNI_RANGE(4.096 / 2)
222         }
223 };
224
225 static const struct comedi_lrange range_usbdux_ao_range = { 2, {
226                         BIP_RANGE(4.096),
227                         UNI_RANGE(4.096),
228         }
229 };
230
231 /*
232  * private structure of one subdevice
233  */
234
235 /*
236  * This is the structure which holds all the data of
237  * this driver one sub device just now: A/D
238  */
239 struct usbduxsub {
240         /* attached? */
241         int attached;
242         /* is it associated with a subdevice? */
243         int probed;
244         /* pointer to the usb-device */
245         struct usb_device *usbdev;
246         /* actual number of in-buffers */
247         int numOfInBuffers;
248         /* actual number of out-buffers */
249         int numOfOutBuffers;
250         /* ISO-transfer handling: buffers */
251         struct urb **urbIn;
252         struct urb **urbOut;
253         /* pwm-transfer handling */
254         struct urb *urbPwm;
255         /* PWM period */
256         unsigned int pwmPeriod;
257         /* PWM internal delay for the GPIF in the FX2 */
258         int8_t pwmDelay;
259         /* size of the PWM buffer which holds the bit pattern */
260         int sizePwmBuf;
261         /* input buffer for the ISO-transfer */
262         int16_t *inBuffer;
263         /* input buffer for single insn */
264         int16_t *insnBuffer;
265         /* output buffer for single DA outputs */
266         int16_t *outBuffer;
267         /* interface number */
268         int ifnum;
269         /* interface structure in 2.6 */
270         struct usb_interface *interface;
271         /* comedi device for the interrupt context */
272         struct comedi_device *comedidev;
273         /* is it USB_SPEED_HIGH or not? */
274         short int high_speed;
275         /* asynchronous command is running */
276         short int ai_cmd_running;
277         short int ao_cmd_running;
278         /* pwm is running */
279         short int pwm_cmd_running;
280         /* continous aquisition */
281         short int ai_continous;
282         short int ao_continous;
283         /* number of samples to aquire */
284         int ai_sample_count;
285         int ao_sample_count;
286         /* time between samples in units of the timer */
287         unsigned int ai_timer;
288         unsigned int ao_timer;
289         /* counter between aquisitions */
290         unsigned int ai_counter;
291         unsigned int ao_counter;
292         /* interval in frames/uframes */
293         unsigned int ai_interval;
294         /* D/A commands */
295         int8_t *dac_commands;
296         /* commands */
297         int8_t *dux_commands;
298         struct semaphore sem;
299 };
300
301 /*
302  * The pointer to the private usb-data of the driver is also the private data
303  * for the comedi-device.  This has to be global as the usb subsystem needs
304  * global variables. The other reason is that this structure must be there
305  * _before_ any comedi command is issued. The usb subsystem must be initialised
306  * before comedi can access it.
307  */
308 static struct usbduxsub usbduxsub[NUMUSBDUX];
309
310 static DECLARE_MUTEX(start_stop_sem);
311
312 /*
313  * Stops the data acquision
314  * It should be safe to call this function from any context
315  */
316 static int usbduxsub_unlink_InURBs(struct usbduxsub *usbduxsub_tmp)
317 {
318         int i = 0;
319         int err = 0;
320
321         if (usbduxsub_tmp && usbduxsub_tmp->urbIn) {
322                 for (i = 0; i < usbduxsub_tmp->numOfInBuffers; i++) {
323                         if (usbduxsub_tmp->urbIn[i]) {
324                                 /* We wait here until all transfers have been
325                                  * cancelled. */
326                                 usb_kill_urb(usbduxsub_tmp->urbIn[i]);
327                         }
328                         dev_dbg(&usbduxsub_tmp->interface->dev,
329                                 "comedi: usbdux: unlinked InURB %d, err=%d\n",
330                                 i, err);
331                 }
332         }
333         return err;
334 }
335
336 /*
337  * This will stop a running acquisition operation
338  * Is called from within this driver from both the
339  * interrupt context and from comedi
340  */
341 static int usbdux_ai_stop(struct usbduxsub *this_usbduxsub, int do_unlink)
342 {
343         int ret = 0;
344
345         if (!this_usbduxsub) {
346                 dev_err(&this_usbduxsub->interface->dev,
347                         "comedi?: usbdux_ai_stop: this_usbduxsub=NULL!\n");
348                 return -EFAULT;
349         }
350         dev_dbg(&this_usbduxsub->interface->dev, "comedi: usbdux_ai_stop\n");
351
352         if (do_unlink) {
353                 /* stop aquistion */
354                 ret = usbduxsub_unlink_InURBs(this_usbduxsub);
355         }
356
357         this_usbduxsub->ai_cmd_running = 0;
358
359         return ret;
360 }
361
362 /*
363  * This will cancel a running acquisition operation.
364  * This is called by comedi but never from inside the driver.
365  */
366 static int usbdux_ai_cancel(struct comedi_device *dev, struct comedi_subdevice *s)
367 {
368         struct usbduxsub *this_usbduxsub;
369         int res = 0;
370
371         /* force unlink of all urbs */
372         this_usbduxsub = dev->private;
373         if (!this_usbduxsub)
374                 return -EFAULT;
375
376         dev_dbg(&this_usbduxsub->interface->dev, "comedi: usbdux_ai_cancel\n");
377
378         /* prevent other CPUs from submitting new commands just now */
379         down(&this_usbduxsub->sem);
380         if (!(this_usbduxsub->probed)) {
381                 up(&this_usbduxsub->sem);
382                 return -ENODEV;
383         }
384         /* unlink only if the urb really has been submitted */
385         res = usbdux_ai_stop(this_usbduxsub, this_usbduxsub->ai_cmd_running);
386         up(&this_usbduxsub->sem);
387         return res;
388 }
389
390 /* analogue IN - interrupt service routine */
391 static void usbduxsub_ai_IsocIrq(struct urb *urb)
392 {
393         int i, err, n;
394         struct usbduxsub *this_usbduxsub;
395         struct comedi_device *this_comedidev;
396         struct comedi_subdevice *s;
397
398         /* the context variable points to the subdevice */
399         this_comedidev = urb->context;
400         /* the private structure of the subdevice is struct usbduxsub */
401         this_usbduxsub = this_comedidev->private;
402         /* subdevice which is the AD converter */
403         s = this_comedidev->subdevices + SUBDEV_AD;
404
405         /* first we test if something unusual has just happened */
406         switch (urb->status) {
407         case 0:
408                 /* copy the result in the transfer buffer */
409                 memcpy(this_usbduxsub->inBuffer,
410                         urb->transfer_buffer, SIZEINBUF);
411                 break;
412         case -EILSEQ:
413                 /* error in the ISOchronous data */
414                 /* we don't copy the data into the transfer buffer */
415                 /* and recycle the last data byte */
416                 dev_dbg(&urb->dev->dev,
417                         "comedi%d: usbdux: CRC error in ISO IN stream.\n",
418                         this_usbduxsub->comedidev->minor);
419
420                 break;
421
422         case -ECONNRESET:
423         case -ENOENT:
424         case -ESHUTDOWN:
425         case -ECONNABORTED:
426                 /* happens after an unlink command */
427                 if (this_usbduxsub->ai_cmd_running) {
428                         /* we are still running a command */
429                         /* tell this comedi */
430                         s->async->events |= COMEDI_CB_EOA;
431                         s->async->events |= COMEDI_CB_ERROR;
432                         comedi_event(this_usbduxsub->comedidev, s);
433                         /* stop the transfer w/o unlink */
434                         usbdux_ai_stop(this_usbduxsub, 0);
435                 }
436                 return;
437
438         default:
439                 /* a real error on the bus */
440                 /* pass error to comedi if we are really running a command */
441                 if (this_usbduxsub->ai_cmd_running) {
442                         dev_err(&urb->dev->dev,
443                                 "Non-zero urb status received in ai intr "
444                                 "context: %d\n", urb->status);
445                         s->async->events |= COMEDI_CB_EOA;
446                         s->async->events |= COMEDI_CB_ERROR;
447                         comedi_event(this_usbduxsub->comedidev, s);
448                         /* don't do an unlink here */
449                         usbdux_ai_stop(this_usbduxsub, 0);
450                 }
451                 return;
452         }
453
454         /*
455          * at this point we are reasonably sure that nothing dodgy has happened
456          * are we running a command?
457          */
458         if (unlikely((!(this_usbduxsub->ai_cmd_running)))) {
459                 /*
460                  * not running a command, do not continue execution if no
461                  * asynchronous command is running in particular not resubmit
462                  */
463                 return;
464         }
465
466         urb->dev = this_usbduxsub->usbdev;
467
468         /* resubmit the urb */
469         err = usb_submit_urb(urb, GFP_ATOMIC);
470         if (unlikely(err < 0)) {
471                 dev_err(&urb->dev->dev,
472                         "comedi_: urb resubmit failed in int-context! err=%d\n",
473                         err);
474                 if (err == -EL2NSYNC)
475                         dev_err(&urb->dev->dev,
476                                 "buggy USB host controller or bug in IRQ "
477                                 "handler!\n");
478                 s->async->events |= COMEDI_CB_EOA;
479                 s->async->events |= COMEDI_CB_ERROR;
480                 comedi_event(this_usbduxsub->comedidev, s);
481                 /* don't do an unlink here */
482                 usbdux_ai_stop(this_usbduxsub, 0);
483                 return;
484         }
485
486         this_usbduxsub->ai_counter--;
487         if (likely(this_usbduxsub->ai_counter > 0))
488                 return;
489
490         /* timer zero, transfer measurements to comedi */
491         this_usbduxsub->ai_counter = this_usbduxsub->ai_timer;
492
493         /* test, if we transmit only a fixed number of samples */
494         if (!(this_usbduxsub->ai_continous)) {
495                 /* not continous, fixed number of samples */
496                 this_usbduxsub->ai_sample_count--;
497                 /* all samples received? */
498                 if (this_usbduxsub->ai_sample_count < 0) {
499                         /* prevent a resubmit next time */
500                         usbdux_ai_stop(this_usbduxsub, 0);
501                         /* say comedi that the acquistion is over */
502                         s->async->events |= COMEDI_CB_EOA;
503                         comedi_event(this_usbduxsub->comedidev, s);
504                         return;
505                 }
506         }
507         /* get the data from the USB bus and hand it over to comedi */
508         n = s->async->cmd.chanlist_len;
509         for (i = 0; i < n; i++) {
510                 /* transfer data */
511                 if (CR_RANGE(s->async->cmd.chanlist[i]) <= 1) {
512                         comedi_buf_put
513                                 (s->async,
514                                 le16_to_cpu(this_usbduxsub->
515                                         inBuffer[i]) ^ 0x800);
516                 } else {
517                         comedi_buf_put
518                                 (s->async,
519                                 le16_to_cpu(this_usbduxsub->inBuffer[i]));
520                 }
521         }
522         /* tell comedi that data is there */
523         comedi_event(this_usbduxsub->comedidev, s);
524 }
525
526 static int usbduxsub_unlink_OutURBs(struct usbduxsub *usbduxsub_tmp)
527 {
528         int i = 0;
529         int err = 0;
530
531         if (usbduxsub_tmp && usbduxsub_tmp->urbOut) {
532                 for (i = 0; i < usbduxsub_tmp->numOfOutBuffers; i++) {
533                         if (usbduxsub_tmp->urbOut[i])
534                                 usb_kill_urb(usbduxsub_tmp->urbOut[i]);
535
536                         dev_dbg(&usbduxsub_tmp->interface->dev,
537                                 "comedi: usbdux: unlinked OutURB %d: res=%d\n",
538                                 i, err);
539                 }
540         }
541         return err;
542 }
543
544 /* This will cancel a running acquisition operation
545  * in any context.
546  */
547 static int usbdux_ao_stop(struct usbduxsub *this_usbduxsub, int do_unlink)
548 {
549         int ret = 0;
550
551         if (!this_usbduxsub)
552                 return -EFAULT;
553         dev_dbg(&this_usbduxsub->interface->dev, "comedi: usbdux_ao_cancel\n");
554
555         if (do_unlink)
556                 ret = usbduxsub_unlink_OutURBs(this_usbduxsub);
557
558         this_usbduxsub->ao_cmd_running = 0;
559
560         return ret;
561 }
562
563 /* force unlink, is called by comedi */
564 static int usbdux_ao_cancel(struct comedi_device *dev, struct comedi_subdevice *s)
565 {
566         struct usbduxsub *this_usbduxsub = dev->private;
567         int res = 0;
568
569         if (!this_usbduxsub)
570                 return -EFAULT;
571
572         /* prevent other CPUs from submitting a command just now */
573         down(&this_usbduxsub->sem);
574         if (!(this_usbduxsub->probed)) {
575                 up(&this_usbduxsub->sem);
576                 return -ENODEV;
577         }
578         /* unlink only if it is really running */
579         res = usbdux_ao_stop(this_usbduxsub, this_usbduxsub->ao_cmd_running);
580         up(&this_usbduxsub->sem);
581         return res;
582 }
583
584 static void usbduxsub_ao_IsocIrq(struct urb *urb)
585 {
586         int i, ret;
587         int8_t *datap;
588         struct usbduxsub *this_usbduxsub;
589         struct comedi_device *this_comedidev;
590         struct comedi_subdevice *s;
591
592         /* the context variable points to the subdevice */
593         this_comedidev = urb->context;
594         /* the private structure of the subdevice is struct usbduxsub */
595         this_usbduxsub = this_comedidev->private;
596
597         s = this_comedidev->subdevices + SUBDEV_DA;
598
599         switch (urb->status) {
600         case 0:
601                 /* success */
602                 break;
603
604         case -ECONNRESET:
605         case -ENOENT:
606         case -ESHUTDOWN:
607         case -ECONNABORTED:
608                 /* after an unlink command, unplug, ... etc */
609                 /* no unlink needed here. Already shutting down. */
610                 if (this_usbduxsub->ao_cmd_running) {
611                         s->async->events |= COMEDI_CB_EOA;
612                         comedi_event(this_usbduxsub->comedidev, s);
613                         usbdux_ao_stop(this_usbduxsub, 0);
614                 }
615                 return;
616
617         default:
618                 /* a real error */
619                 if (this_usbduxsub->ao_cmd_running) {
620                         dev_err(&urb->dev->dev,
621                                 "comedi_: Non-zero urb status received in ao "
622                                 "intr context: %d\n", urb->status);
623                         s->async->events |= COMEDI_CB_ERROR;
624                         s->async->events |= COMEDI_CB_EOA;
625                         comedi_event(this_usbduxsub->comedidev, s);
626                         /* we do an unlink if we are in the high speed mode */
627                         usbdux_ao_stop(this_usbduxsub, 0);
628                 }
629                 return;
630         }
631
632         /* are we actually running? */
633         if (!(this_usbduxsub->ao_cmd_running))
634                 return;
635
636         /* normal operation: executing a command in this subdevice */
637         this_usbduxsub->ao_counter--;
638         if (this_usbduxsub->ao_counter <= 0) {
639                 /* timer zero */
640                 this_usbduxsub->ao_counter = this_usbduxsub->ao_timer;
641
642                 /* handle non continous aquisition */
643                 if (!(this_usbduxsub->ao_continous)) {
644                         /* fixed number of samples */
645                         this_usbduxsub->ao_sample_count--;
646                         if (this_usbduxsub->ao_sample_count < 0) {
647                                 /* all samples transmitted */
648                                 usbdux_ao_stop(this_usbduxsub, 0);
649                                 s->async->events |= COMEDI_CB_EOA;
650                                 comedi_event(this_usbduxsub->comedidev, s);
651                                 /* no resubmit of the urb */
652                                 return;
653                         }
654                 }
655                 /* transmit data to the USB bus */
656                 ((uint8_t *) (urb->transfer_buffer))[0] =
657                         s->async->cmd.chanlist_len;
658                 for (i = 0; i < s->async->cmd.chanlist_len; i++) {
659                         short temp;
660                         if (i >= NUMOUTCHANNELS)
661                                 break;
662
663                         /* pointer to the DA */
664                         datap =
665                                (&(((int8_t *)urb->transfer_buffer)[i * 3 + 1]));
666                         /* get the data from comedi */
667                         ret = comedi_buf_get(s->async, &temp);
668                         datap[0] = temp;
669                         datap[1] = temp >> 8;
670                         datap[2] = this_usbduxsub->dac_commands[i];
671                         /* printk("data[0]=%x, data[1]=%x, data[2]=%x\n", */
672                         /* datap[0],datap[1],datap[2]); */
673                         if (ret < 0) {
674                                 dev_err(&urb->dev->dev,
675                                         "comedi: buffer underflow\n");
676                                 s->async->events |= COMEDI_CB_EOA;
677                                 s->async->events |= COMEDI_CB_OVERFLOW;
678                         }
679                         /* transmit data to comedi */
680                         s->async->events |= COMEDI_CB_BLOCK;
681                         comedi_event(this_usbduxsub->comedidev, s);
682                 }
683         }
684         urb->transfer_buffer_length = SIZEOUTBUF;
685         urb->dev = this_usbduxsub->usbdev;
686         urb->status = 0;
687         if (this_usbduxsub->ao_cmd_running) {
688                 if (this_usbduxsub->high_speed) {
689                         /* uframes */
690                         urb->interval = 8;
691                 } else {
692                         /* frames */
693                         urb->interval = 1;
694                 }
695                 urb->number_of_packets = 1;
696                 urb->iso_frame_desc[0].offset = 0;
697                 urb->iso_frame_desc[0].length = SIZEOUTBUF;
698                 urb->iso_frame_desc[0].status = 0;
699                 ret = usb_submit_urb(urb, GFP_ATOMIC);
700                 if (ret < 0) {
701                         dev_err(&urb->dev->dev,
702                                 "comedi_: ao urb resubm failed in int-cont. "
703                                 "ret=%d", ret);
704                         if (ret == EL2NSYNC)
705                                 dev_err(&urb->dev->dev,
706                                         "buggy USB host controller or bug in "
707                                         "IRQ handling!\n");
708
709                         s->async->events |= COMEDI_CB_EOA;
710                         s->async->events |= COMEDI_CB_ERROR;
711                         comedi_event(this_usbduxsub->comedidev, s);
712                         /* don't do an unlink here */
713                         usbdux_ao_stop(this_usbduxsub, 0);
714                 }
715         }
716 }
717
718 static int usbduxsub_start(struct usbduxsub *usbduxsub)
719 {
720         int errcode = 0;
721         uint8_t local_transfer_buffer[16];
722
723         /* 7f92 to zero */
724         local_transfer_buffer[0] = 0;
725         errcode = usb_control_msg(usbduxsub->usbdev,
726                                   /* create a pipe for a control transfer */
727                                   usb_sndctrlpipe(usbduxsub->usbdev, 0),
728                                   /* bRequest, "Firmware" */
729                                   USBDUXSUB_FIRMWARE,
730                                   /* bmRequestType */
731                                   VENDOR_DIR_OUT,
732                                   /* Value */
733                                   USBDUXSUB_CPUCS,
734                                   /* Index */
735                                   0x0000,
736                                   /* address of the transfer buffer */
737                                   local_transfer_buffer,
738                                   /* Length */
739                                   1,
740                                   /* Timeout */
741                                   EZTIMEOUT);
742         if (errcode < 0) {
743                 dev_err(&usbduxsub->interface->dev,
744                         "comedi_: control msg failed (start)\n");
745                 return errcode;
746         }
747         return 0;
748 }
749
750 static int usbduxsub_stop(struct usbduxsub *usbduxsub)
751 {
752         int errcode = 0;
753
754         uint8_t local_transfer_buffer[16];
755
756         /* 7f92 to one */
757         local_transfer_buffer[0] = 1;
758         errcode = usb_control_msg(usbduxsub->usbdev,
759                                   usb_sndctrlpipe(usbduxsub->usbdev, 0),
760                                   /* bRequest, "Firmware" */
761                                   USBDUXSUB_FIRMWARE,
762                                   /* bmRequestType */
763                                   VENDOR_DIR_OUT,
764                                   /* Value */
765                                   USBDUXSUB_CPUCS,
766                                   /* Index */
767                                   0x0000, local_transfer_buffer,
768                                   /* Length */
769                                   1,
770                                   /* Timeout */
771                                   EZTIMEOUT);
772         if (errcode < 0) {
773                 dev_err(&usbduxsub->interface->dev,
774                         "comedi_: control msg failed (stop)\n");
775                 return errcode;
776         }
777         return 0;
778 }
779
780 static int usbduxsub_upload(struct usbduxsub *usbduxsub,
781                             uint8_t *local_transfer_buffer,
782                             unsigned int startAddr, unsigned int len)
783 {
784         int errcode;
785
786         errcode = usb_control_msg(usbduxsub->usbdev,
787                         usb_sndctrlpipe(usbduxsub->usbdev, 0),
788                         /* brequest, firmware */
789                         USBDUXSUB_FIRMWARE,
790                         /* bmRequestType */
791                         VENDOR_DIR_OUT,
792                         /* value */
793                         startAddr,
794                         /* index */
795                         0x0000,
796                         /* our local safe buffer */
797                         local_transfer_buffer,
798                         /* length */
799                         len,
800                         /* timeout */
801                         EZTIMEOUT);
802         dev_dbg(&usbduxsub->interface->dev,
803                 "comedi_: result=%d\n", errcode);
804         if (errcode < 0) {
805                 dev_err(&usbduxsub->interface->dev,
806                 "comedi_: upload failed\n");
807                 return errcode;
808         }
809         return 0;
810 }
811
812 static int firmwareUpload(struct usbduxsub *usbduxsub, uint8_t *firmwareBinary,
813                           int sizeFirmware)
814 {
815         int ret;
816
817         if (!firmwareBinary)
818                 return 0;
819
820         ret = usbduxsub_stop(usbduxsub);
821         if (ret < 0) {
822                 dev_err(&usbduxsub->interface->dev,
823                         "comedi_: can not stop firmware\n");
824                 return ret;
825         }
826         ret = usbduxsub_upload(usbduxsub, firmwareBinary, 0, sizeFirmware);
827         if (ret < 0) {
828                 dev_err(&usbduxsub->interface->dev,
829                         "comedi_: firmware upload failed\n");
830                 return ret;
831         }
832         ret = usbduxsub_start(usbduxsub);
833         if (ret < 0) {
834                 dev_err(&usbduxsub->interface->dev,
835                         "comedi_: can not start firmware\n");
836                 return ret;
837         }
838         return 0;
839 }
840
841 static int usbduxsub_submit_InURBs(struct usbduxsub *usbduxsub)
842 {
843         int i, errFlag;
844
845         if (!usbduxsub)
846                 return -EFAULT;
847
848         /* Submit all URBs and start the transfer on the bus */
849         for (i = 0; i < usbduxsub->numOfInBuffers; i++) {
850                 /* in case of a resubmission after an unlink... */
851                 usbduxsub->urbIn[i]->interval = usbduxsub->ai_interval;
852                 usbduxsub->urbIn[i]->context = usbduxsub->comedidev;
853                 usbduxsub->urbIn[i]->dev = usbduxsub->usbdev;
854                 usbduxsub->urbIn[i]->status = 0;
855                 usbduxsub->urbIn[i]->transfer_flags = URB_ISO_ASAP;
856                 dev_dbg(&usbduxsub->interface->dev,
857                         "comedi%d: submitting in-urb[%d]: %p,%p intv=%d\n",
858                         usbduxsub->comedidev->minor, i,
859                         (usbduxsub->urbIn[i]->context),
860                         (usbduxsub->urbIn[i]->dev),
861                         (usbduxsub->urbIn[i]->interval));
862                 errFlag = usb_submit_urb(usbduxsub->urbIn[i], GFP_ATOMIC);
863                 if (errFlag) {
864                         dev_err(&usbduxsub->interface->dev,
865                                 "comedi_: ai: usb_submit_urb(%d) error %d\n",
866                                 i, errFlag);
867                         return errFlag;
868                 }
869         }
870         return 0;
871 }
872
873 static int usbduxsub_submit_OutURBs(struct usbduxsub *usbduxsub)
874 {
875         int i, errFlag;
876
877         if (!usbduxsub)
878                 return -EFAULT;
879
880         for (i = 0; i < usbduxsub->numOfOutBuffers; i++) {
881                 dev_dbg(&usbduxsub->interface->dev,
882                         "comedi_: submitting out-urb[%d]\n", i);
883                 /* in case of a resubmission after an unlink... */
884                 usbduxsub->urbOut[i]->context = usbduxsub->comedidev;
885                 usbduxsub->urbOut[i]->dev = usbduxsub->usbdev;
886                 usbduxsub->urbOut[i]->status = 0;
887                 usbduxsub->urbOut[i]->transfer_flags = URB_ISO_ASAP;
888                 errFlag = usb_submit_urb(usbduxsub->urbOut[i], GFP_ATOMIC);
889                 if (errFlag) {
890                         dev_err(&usbduxsub->interface->dev,
891                                 "comedi_: ao: usb_submit_urb(%d) error %d\n",
892                                 i, errFlag);
893                         return errFlag;
894                 }
895         }
896         return 0;
897 }
898
899 static int usbdux_ai_cmdtest(struct comedi_device *dev, struct comedi_subdevice *s,
900                              struct comedi_cmd *cmd)
901 {
902         int err = 0, tmp, i;
903         unsigned int tmpTimer;
904         struct usbduxsub *this_usbduxsub = dev->private;
905
906         if (!(this_usbduxsub->probed))
907                 return -ENODEV;
908
909         dev_dbg(&this_usbduxsub->interface->dev,
910                 "comedi%d: usbdux_ai_cmdtest\n", dev->minor);
911
912         /* make sure triggers are valid */
913         /* Only immediate triggers are allowed */
914         tmp = cmd->start_src;
915         cmd->start_src &= TRIG_NOW | TRIG_INT;
916         if (!cmd->start_src || tmp != cmd->start_src)
917                 err++;
918
919         /* trigger should happen timed */
920         tmp = cmd->scan_begin_src;
921         /* start a new _scan_ with a timer */
922         cmd->scan_begin_src &= TRIG_TIMER;
923         if (!cmd->scan_begin_src || tmp != cmd->scan_begin_src)
924                 err++;
925
926         /* scanning is continous */
927         tmp = cmd->convert_src;
928         cmd->convert_src &= TRIG_NOW;
929         if (!cmd->convert_src || tmp != cmd->convert_src)
930                 err++;
931
932         /* issue a trigger when scan is finished and start a new scan */
933         tmp = cmd->scan_end_src;
934         cmd->scan_end_src &= TRIG_COUNT;
935         if (!cmd->scan_end_src || tmp != cmd->scan_end_src)
936                 err++;
937
938         /* trigger at the end of count events or not, stop condition or not */
939         tmp = cmd->stop_src;
940         cmd->stop_src &= TRIG_COUNT | TRIG_NONE;
941         if (!cmd->stop_src || tmp != cmd->stop_src)
942                 err++;
943
944         if (err)
945                 return 1;
946
947         /*
948          * step 2: make sure trigger sources are unique and mutually compatible
949          * note that mutual compatiblity is not an issue here
950          */
951         if (cmd->scan_begin_src != TRIG_FOLLOW &&
952                 cmd->scan_begin_src != TRIG_EXT &&
953                 cmd->scan_begin_src != TRIG_TIMER)
954                 err++;
955         if (cmd->stop_src != TRIG_COUNT && cmd->stop_src != TRIG_NONE)
956                 err++;
957
958         if (err)
959                 return 2;
960
961         /* step 3: make sure arguments are trivially compatible */
962         if (cmd->start_arg != 0) {
963                 cmd->start_arg = 0;
964                 err++;
965         }
966
967         if (cmd->scan_begin_src == TRIG_FOLLOW) {
968                 /* internal trigger */
969                 if (cmd->scan_begin_arg != 0) {
970                         cmd->scan_begin_arg = 0;
971                         err++;
972                 }
973         }
974
975         if (cmd->scan_begin_src == TRIG_TIMER) {
976                 if (this_usbduxsub->high_speed) {
977                         /*
978                          * In high speed mode microframes are possible.
979                          * However, during one microframe we can roughly
980                          * sample one channel. Thus, the more channels
981                          * are in the channel list the more time we need.
982                          */
983                         i = 1;
984                         /* find a power of 2 for the number of channels */
985                         while (i < (cmd->chanlist_len))
986                                 i = i * 2;
987
988                         if (cmd->scan_begin_arg < (1000000 / 8 * i)) {
989                                 cmd->scan_begin_arg = 1000000 / 8 * i;
990                                 err++;
991                         }
992                         /* now calc the real sampling rate with all the
993                          * rounding errors */
994                         tmpTimer =
995                                 ((unsigned int)(cmd->scan_begin_arg / 125000)) *
996                                 125000;
997                         if (cmd->scan_begin_arg != tmpTimer) {
998                                 cmd->scan_begin_arg = tmpTimer;
999                                 err++;
1000                         }
1001                 } else {
1002                         /* full speed */
1003                         /* 1kHz scans every USB frame */
1004                         if (cmd->scan_begin_arg < 1000000) {
1005                                 cmd->scan_begin_arg = 1000000;
1006                                 err++;
1007                         }
1008                         /*
1009                          * calc the real sampling rate with the rounding errors
1010                          */
1011                         tmpTimer = ((unsigned int)(cmd->scan_begin_arg /
1012                                         1000000)) * 1000000;
1013                         if (cmd->scan_begin_arg != tmpTimer) {
1014                                 cmd->scan_begin_arg = tmpTimer;
1015                                 err++;
1016                         }
1017                 }
1018         }
1019         /* the same argument */
1020         if (cmd->scan_end_arg != cmd->chanlist_len) {
1021                 cmd->scan_end_arg = cmd->chanlist_len;
1022                 err++;
1023         }
1024
1025         if (cmd->stop_src == TRIG_COUNT) {
1026                 /* any count is allowed */
1027         } else {
1028                 /* TRIG_NONE */
1029                 if (cmd->stop_arg != 0) {
1030                         cmd->stop_arg = 0;
1031                         err++;
1032                 }
1033         }
1034
1035         if (err)
1036                 return 3;
1037
1038         return 0;
1039 }
1040
1041 /*
1042  * creates the ADC command for the MAX1271
1043  * range is the range value from comedi
1044  */
1045 static int8_t create_adc_command(unsigned int chan, int range)
1046 {
1047         int8_t p = (range <= 1);
1048         int8_t r = ((range % 2) == 0);
1049         return (chan << 4) | ((p == 1) << 2) | ((r == 1) << 3);
1050 }
1051
1052 /* bulk transfers to usbdux */
1053
1054 #define SENDADCOMMANDS            0
1055 #define SENDDACOMMANDS            1
1056 #define SENDDIOCONFIGCOMMAND      2
1057 #define SENDDIOBITSCOMMAND        3
1058 #define SENDSINGLEAD              4
1059 #define READCOUNTERCOMMAND        5
1060 #define WRITECOUNTERCOMMAND       6
1061 #define SENDPWMON                 7
1062 #define SENDPWMOFF                8
1063
1064 static int send_dux_commands(struct usbduxsub *this_usbduxsub, int cmd_type)
1065 {
1066         int result, nsent;
1067
1068         this_usbduxsub->dux_commands[0] = cmd_type;
1069 #ifdef NOISY_DUX_DEBUGBUG
1070         printk(KERN_DEBUG "comedi%d: usbdux: dux_commands: ",
1071                 this_usbduxsub->comedidev->minor);
1072         for (result = 0; result < SIZEOFDUXBUFFER; result++)
1073                 printk(" %02x", this_usbduxsub->dux_commands[result]);
1074         printk("\n");
1075 #endif
1076         result = usb_bulk_msg(this_usbduxsub->usbdev,
1077                               usb_sndbulkpipe(this_usbduxsub->usbdev,
1078                                               COMMAND_OUT_EP),
1079                               this_usbduxsub->dux_commands, SIZEOFDUXBUFFER,
1080                               &nsent, 10);
1081         if (result < 0)
1082                 dev_err(&this_usbduxsub->interface->dev, "comedi%d: "
1083                         "could not transmit dux_command to the usb-device, "
1084                         "err=%d\n", this_usbduxsub->comedidev->minor, result);
1085
1086         return result;
1087 }
1088
1089 static int receive_dux_commands(struct usbduxsub *this_usbduxsub, int command)
1090 {
1091         int result = (-EFAULT);
1092         int nrec;
1093         int i;
1094
1095         for (i = 0; i < RETRIES; i++) {
1096                 result = usb_bulk_msg(this_usbduxsub->usbdev,
1097                                       usb_rcvbulkpipe(this_usbduxsub->usbdev,
1098                                                       COMMAND_IN_EP),
1099                                       this_usbduxsub->insnBuffer, SIZEINSNBUF,
1100                                       &nrec, 1);
1101                 if (result < 0) {
1102                         dev_err(&this_usbduxsub->interface->dev, "comedi%d: "
1103                                 "insn: USB error %d while receiving DUX command"
1104                                 "\n", this_usbduxsub->comedidev->minor, result);
1105                         return result;
1106                 }
1107                 if (le16_to_cpu(this_usbduxsub->insnBuffer[0]) == command)
1108                         return result;
1109         }
1110         /* this is only reached if the data has been requested a couple of
1111          * times */
1112         dev_err(&this_usbduxsub->interface->dev, "comedi%d: insn: "
1113                 "wrong data returned from firmware: want cmd %d, got cmd %d.\n",
1114                 this_usbduxsub->comedidev->minor, command,
1115                 le16_to_cpu(this_usbduxsub->insnBuffer[0]));
1116         return -EFAULT;
1117 }
1118
1119 static int usbdux_ai_inttrig(struct comedi_device *dev, struct comedi_subdevice *s,
1120                              unsigned int trignum)
1121 {
1122         int ret;
1123         struct usbduxsub *this_usbduxsub = dev->private;
1124         if (!this_usbduxsub)
1125                 return -EFAULT;
1126
1127         down(&this_usbduxsub->sem);
1128         if (!(this_usbduxsub->probed)) {
1129                 up(&this_usbduxsub->sem);
1130                 return -ENODEV;
1131         }
1132         dev_dbg(&this_usbduxsub->interface->dev,
1133                 "comedi%d: usbdux_ai_inttrig\n", dev->minor);
1134
1135         if (trignum != 0) {
1136                 dev_err(&this_usbduxsub->interface->dev,
1137                         "comedi%d: usbdux_ai_inttrig: invalid trignum\n",
1138                         dev->minor);
1139                 up(&this_usbduxsub->sem);
1140                 return -EINVAL;
1141         }
1142         if (!(this_usbduxsub->ai_cmd_running)) {
1143                 this_usbduxsub->ai_cmd_running = 1;
1144                 ret = usbduxsub_submit_InURBs(this_usbduxsub);
1145                 if (ret < 0) {
1146                         dev_err(&this_usbduxsub->interface->dev,
1147                                 "comedi%d: usbdux_ai_inttrig: "
1148                                 "urbSubmit: err=%d\n", dev->minor, ret);
1149                         this_usbduxsub->ai_cmd_running = 0;
1150                         up(&this_usbduxsub->sem);
1151                         return ret;
1152                 }
1153                 s->async->inttrig = NULL;
1154         } else {
1155                 dev_err(&this_usbduxsub->interface->dev,
1156                         "comedi%d: ai_inttrig but acqu is already running\n",
1157                         dev->minor);
1158         }
1159         up(&this_usbduxsub->sem);
1160         return 1;
1161 }
1162
1163 static int usbdux_ai_cmd(struct comedi_device *dev, struct comedi_subdevice *s)
1164 {
1165         struct comedi_cmd *cmd = &s->async->cmd;
1166         unsigned int chan, range;
1167         int i, ret;
1168         struct usbduxsub *this_usbduxsub = dev->private;
1169         int result;
1170
1171         if (!this_usbduxsub)
1172                 return -EFAULT;
1173
1174         dev_dbg(&this_usbduxsub->interface->dev,
1175                 "comedi%d: usbdux_ai_cmd\n", dev->minor);
1176
1177         /* block other CPUs from starting an ai_cmd */
1178         down(&this_usbduxsub->sem);
1179
1180         if (!(this_usbduxsub->probed)) {
1181                 up(&this_usbduxsub->sem);
1182                 return -ENODEV;
1183         }
1184         if (this_usbduxsub->ai_cmd_running) {
1185                 dev_err(&this_usbduxsub->interface->dev, "comedi%d: "
1186                         "ai_cmd not possible. Another ai_cmd is running.\n",
1187                         dev->minor);
1188                 up(&this_usbduxsub->sem);
1189                 return -EBUSY;
1190         }
1191         /* set current channel of the running aquisition to zero */
1192         s->async->cur_chan = 0;
1193
1194         this_usbduxsub->dux_commands[1] = cmd->chanlist_len;
1195         for (i = 0; i < cmd->chanlist_len; ++i) {
1196                 chan = CR_CHAN(cmd->chanlist[i]);
1197                 range = CR_RANGE(cmd->chanlist[i]);
1198                 if (i >= NUMCHANNELS) {
1199                         dev_err(&this_usbduxsub->interface->dev,
1200                                 "comedi%d: channel list too long\n",
1201                                 dev->minor);
1202                         break;
1203                 }
1204                 this_usbduxsub->dux_commands[i + 2] =
1205                         create_adc_command(chan, range);
1206         }
1207
1208         dev_dbg(&this_usbduxsub->interface->dev,
1209                 "comedi %d: sending commands to the usb device: size=%u\n",
1210                 dev->minor, NUMCHANNELS);
1211
1212         result = send_dux_commands(this_usbduxsub, SENDADCOMMANDS);
1213         if (result < 0) {
1214                 up(&this_usbduxsub->sem);
1215                 return result;
1216         }
1217
1218         if (this_usbduxsub->high_speed) {
1219                 /*
1220                  * every channel gets a time window of 125us. Thus, if we
1221                  * sample all 8 channels we need 1ms. If we sample only one
1222                  * channel we need only 125us
1223                  */
1224                 this_usbduxsub->ai_interval = 1;
1225                 /* find a power of 2 for the interval */
1226                 while ((this_usbduxsub->ai_interval) < (cmd->chanlist_len)) {
1227                         this_usbduxsub->ai_interval =
1228                                 (this_usbduxsub->ai_interval) * 2;
1229                 }
1230                 this_usbduxsub->ai_timer = cmd->scan_begin_arg / (125000 *
1231                         (this_usbduxsub->ai_interval));
1232         } else {
1233                 /* interval always 1ms */
1234                 this_usbduxsub->ai_interval = 1;
1235                 this_usbduxsub->ai_timer = cmd->scan_begin_arg / 1000000;
1236         }
1237         if (this_usbduxsub->ai_timer < 1) {
1238                 dev_err(&this_usbduxsub->interface->dev, "comedi%d: ai_cmd: "
1239                         "timer=%d, scan_begin_arg=%d. "
1240                         "Not properly tested by cmdtest?\n", dev->minor,
1241                         this_usbduxsub->ai_timer, cmd->scan_begin_arg);
1242                 up(&this_usbduxsub->sem);
1243                 return -EINVAL;
1244         }
1245         this_usbduxsub->ai_counter = this_usbduxsub->ai_timer;
1246
1247         if (cmd->stop_src == TRIG_COUNT) {
1248                 /* data arrives as one packet */
1249                 this_usbduxsub->ai_sample_count = cmd->stop_arg;
1250                 this_usbduxsub->ai_continous = 0;
1251         } else {
1252                 /* continous aquisition */
1253                 this_usbduxsub->ai_continous = 1;
1254                 this_usbduxsub->ai_sample_count = 0;
1255         }
1256
1257         if (cmd->start_src == TRIG_NOW) {
1258                 /* enable this acquisition operation */
1259                 this_usbduxsub->ai_cmd_running = 1;
1260                 ret = usbduxsub_submit_InURBs(this_usbduxsub);
1261                 if (ret < 0) {
1262                         this_usbduxsub->ai_cmd_running = 0;
1263                         /* fixme: unlink here?? */
1264                         up(&this_usbduxsub->sem);
1265                         return ret;
1266                 }
1267                 s->async->inttrig = NULL;
1268         } else {
1269                 /* TRIG_INT */
1270                 /* don't enable the acquision operation */
1271                 /* wait for an internal signal */
1272                 s->async->inttrig = usbdux_ai_inttrig;
1273         }
1274         up(&this_usbduxsub->sem);
1275         return 0;
1276 }
1277
1278 /* Mode 0 is used to get a single conversion on demand */
1279 static int usbdux_ai_insn_read(struct comedi_device *dev, struct comedi_subdevice *s,
1280                                struct comedi_insn *insn, unsigned int *data)
1281 {
1282         int i;
1283         unsigned int one = 0;
1284         int chan, range;
1285         int err;
1286         struct usbduxsub *this_usbduxsub = dev->private;
1287
1288         if (!this_usbduxsub)
1289                 return 0;
1290
1291         dev_dbg(&this_usbduxsub->interface->dev,
1292                 "comedi%d: ai_insn_read, insn->n=%d, insn->subdev=%d\n",
1293                 dev->minor, insn->n, insn->subdev);
1294
1295         down(&this_usbduxsub->sem);
1296         if (!(this_usbduxsub->probed)) {
1297                 up(&this_usbduxsub->sem);
1298                 return -ENODEV;
1299         }
1300         if (this_usbduxsub->ai_cmd_running) {
1301                 dev_err(&this_usbduxsub->interface->dev,
1302                         "comedi%d: ai_insn_read not possible. "
1303                         "Async Command is running.\n", dev->minor);
1304                 up(&this_usbduxsub->sem);
1305                 return 0;
1306         }
1307
1308         /* sample one channel */
1309         chan = CR_CHAN(insn->chanspec);
1310         range = CR_RANGE(insn->chanspec);
1311         /* set command for the first channel */
1312         this_usbduxsub->dux_commands[1] = create_adc_command(chan, range);
1313
1314         /* adc commands */
1315         err = send_dux_commands(this_usbduxsub, SENDSINGLEAD);
1316         if (err < 0) {
1317                 up(&this_usbduxsub->sem);
1318                 return err;
1319         }
1320
1321         for (i = 0; i < insn->n; i++) {
1322                 err = receive_dux_commands(this_usbduxsub, SENDSINGLEAD);
1323                 if (err < 0) {
1324                         up(&this_usbduxsub->sem);
1325                         return 0;
1326                 }
1327                 one = le16_to_cpu(this_usbduxsub->insnBuffer[1]);
1328                 if (CR_RANGE(insn->chanspec) <= 1)
1329                         one = one ^ 0x800;
1330
1331                 data[i] = one;
1332         }
1333         up(&this_usbduxsub->sem);
1334         return i;
1335 }
1336
1337 /************************************/
1338 /* analog out */
1339
1340 static int usbdux_ao_insn_read(struct comedi_device *dev, struct comedi_subdevice *s,
1341                                struct comedi_insn *insn, unsigned int *data)
1342 {
1343         int i;
1344         int chan = CR_CHAN(insn->chanspec);
1345         struct usbduxsub *this_usbduxsub = dev->private;
1346
1347         if (!this_usbduxsub)
1348                 return -EFAULT;
1349
1350         down(&this_usbduxsub->sem);
1351         if (!(this_usbduxsub->probed)) {
1352                 up(&this_usbduxsub->sem);
1353                 return -ENODEV;
1354         }
1355         for (i = 0; i < insn->n; i++)
1356                 data[i] = this_usbduxsub->outBuffer[chan];
1357
1358         up(&this_usbduxsub->sem);
1359         return i;
1360 }
1361
1362 static int usbdux_ao_insn_write(struct comedi_device *dev, struct comedi_subdevice *s,
1363                                 struct comedi_insn *insn, unsigned int *data)
1364 {
1365         int i, err;
1366         int chan = CR_CHAN(insn->chanspec);
1367         struct usbduxsub *this_usbduxsub = dev->private;
1368
1369         if (!this_usbduxsub)
1370                 return -EFAULT;
1371
1372         dev_dbg(&this_usbduxsub->interface->dev,
1373                 "comedi%d: ao_insn_write\n", dev->minor);
1374
1375         down(&this_usbduxsub->sem);
1376         if (!(this_usbduxsub->probed)) {
1377                 up(&this_usbduxsub->sem);
1378                 return -ENODEV;
1379         }
1380         if (this_usbduxsub->ao_cmd_running) {
1381                 dev_err(&this_usbduxsub->interface->dev,
1382                         "comedi%d: ao_insn_write: "
1383                         "ERROR: asynchronous ao_cmd is running\n", dev->minor);
1384                 up(&this_usbduxsub->sem);
1385                 return 0;
1386         }
1387
1388         for (i = 0; i < insn->n; i++) {
1389                 dev_dbg(&this_usbduxsub->interface->dev,
1390                         "comedi%d: ao_insn_write: data[chan=%d,i=%d]=%d\n",
1391                         dev->minor, chan, i, data[i]);
1392
1393                 /* number of channels: 1 */
1394                 this_usbduxsub->dux_commands[1] = 1;
1395                 /* one 16 bit value */
1396                 *((int16_t *) (this_usbduxsub->dux_commands + 2)) =
1397                         cpu_to_le16(data[i]);
1398                 this_usbduxsub->outBuffer[chan] = data[i];
1399                 /* channel number */
1400                 this_usbduxsub->dux_commands[4] = (chan << 6);
1401                 err = send_dux_commands(this_usbduxsub, SENDDACOMMANDS);
1402                 if (err < 0) {
1403                         up(&this_usbduxsub->sem);
1404                         return err;
1405                 }
1406         }
1407         up(&this_usbduxsub->sem);
1408
1409         return i;
1410 }
1411
1412 static int usbdux_ao_inttrig(struct comedi_device *dev, struct comedi_subdevice *s,
1413                              unsigned int trignum)
1414 {
1415         int ret;
1416         struct usbduxsub *this_usbduxsub = dev->private;
1417
1418         if (!this_usbduxsub)
1419                 return -EFAULT;
1420
1421         down(&this_usbduxsub->sem);
1422         if (!(this_usbduxsub->probed)) {
1423                 up(&this_usbduxsub->sem);
1424                 return -ENODEV;
1425         }
1426         if (trignum != 0) {
1427                 dev_err(&this_usbduxsub->interface->dev,
1428                         "comedi%d: usbdux_ao_inttrig: invalid trignum\n",
1429                         dev->minor);
1430                 return -EINVAL;
1431         }
1432         if (!(this_usbduxsub->ao_cmd_running)) {
1433                 this_usbduxsub->ao_cmd_running = 1;
1434                 ret = usbduxsub_submit_OutURBs(this_usbduxsub);
1435                 if (ret < 0) {
1436                         dev_err(&this_usbduxsub->interface->dev,
1437                                 "comedi%d: usbdux_ao_inttrig: submitURB: "
1438                                 "err=%d\n", dev->minor, ret);
1439                         this_usbduxsub->ao_cmd_running = 0;
1440                         up(&this_usbduxsub->sem);
1441                         return ret;
1442                 }
1443                 s->async->inttrig = NULL;
1444         } else {
1445                 dev_err(&this_usbduxsub->interface->dev,
1446                         "comedi%d: ao_inttrig but acqu is already running.\n",
1447                         dev->minor);
1448         }
1449         up(&this_usbduxsub->sem);
1450         return 1;
1451 }
1452
1453 static int usbdux_ao_cmdtest(struct comedi_device *dev, struct comedi_subdevice *s,
1454                              struct comedi_cmd *cmd)
1455 {
1456         int err = 0, tmp;
1457         struct usbduxsub *this_usbduxsub = dev->private;
1458
1459         if (!this_usbduxsub)
1460                 return -EFAULT;
1461
1462         if (!(this_usbduxsub->probed))
1463                 return -ENODEV;
1464
1465         dev_dbg(&this_usbduxsub->interface->dev,
1466                 "comedi%d: usbdux_ao_cmdtest\n", dev->minor);
1467
1468         /* make sure triggers are valid */
1469         /* Only immediate triggers are allowed */
1470         tmp = cmd->start_src;
1471         cmd->start_src &= TRIG_NOW | TRIG_INT;
1472         if (!cmd->start_src || tmp != cmd->start_src)
1473                 err++;
1474
1475         /* trigger should happen timed */
1476         tmp = cmd->scan_begin_src;
1477         /* just now we scan also in the high speed mode every frame */
1478         /* this is due to ehci driver limitations */
1479         if (0) {                /* (this_usbduxsub->high_speed) */
1480                 /* start immidiately a new scan */
1481                 /* the sampling rate is set by the coversion rate */
1482                 cmd->scan_begin_src &= TRIG_FOLLOW;
1483         } else {
1484                 /* start a new scan (output at once) with a timer */
1485                 cmd->scan_begin_src &= TRIG_TIMER;
1486         }
1487         if (!cmd->scan_begin_src || tmp != cmd->scan_begin_src)
1488                 err++;
1489
1490         /* scanning is continous */
1491         tmp = cmd->convert_src;
1492         /* we always output at 1kHz just now all channels at once */
1493         if (0) {                /* (this_usbduxsub->high_speed) */
1494                 /*
1495                  * in usb-2.0 only one conversion it tranmitted but with 8kHz/n
1496                  */
1497                 cmd->convert_src &= TRIG_TIMER;
1498         } else {
1499                 /* all conversion events happen simultaneously with a rate of
1500                  * 1kHz/n */
1501                 cmd->convert_src &= TRIG_NOW;
1502         }
1503         if (!cmd->convert_src || tmp != cmd->convert_src)
1504                 err++;
1505
1506         /* issue a trigger when scan is finished and start a new scan */
1507         tmp = cmd->scan_end_src;
1508         cmd->scan_end_src &= TRIG_COUNT;
1509         if (!cmd->scan_end_src || tmp != cmd->scan_end_src)
1510                 err++;
1511
1512         /* trigger at the end of count events or not, stop condition or not */
1513         tmp = cmd->stop_src;
1514         cmd->stop_src &= TRIG_COUNT | TRIG_NONE;
1515         if (!cmd->stop_src || tmp != cmd->stop_src)
1516                 err++;
1517
1518         if (err)
1519                 return 1;
1520
1521         /*
1522          * step 2: make sure trigger sources are unique and mutually compatible
1523          * note that mutual compatiblity is not an issue here
1524          */
1525         if (cmd->scan_begin_src != TRIG_FOLLOW &&
1526                 cmd->scan_begin_src != TRIG_EXT &&
1527                 cmd->scan_begin_src != TRIG_TIMER)
1528                 err++;
1529         if (cmd->stop_src != TRIG_COUNT && cmd->stop_src != TRIG_NONE)
1530                 err++;
1531
1532         if (err)
1533                 return 2;
1534
1535         /* step 3: make sure arguments are trivially compatible */
1536
1537         if (cmd->start_arg != 0) {
1538                 cmd->start_arg = 0;
1539                 err++;
1540         }
1541
1542         if (cmd->scan_begin_src == TRIG_FOLLOW) {
1543                 /* internal trigger */
1544                 if (cmd->scan_begin_arg != 0) {
1545                         cmd->scan_begin_arg = 0;
1546                         err++;
1547                 }
1548         }
1549
1550         if (cmd->scan_begin_src == TRIG_TIMER) {
1551                 /* timer */
1552                 if (cmd->scan_begin_arg < 1000000) {
1553                         cmd->scan_begin_arg = 1000000;
1554                         err++;
1555                 }
1556         }
1557         /* not used now, is for later use */
1558         if (cmd->convert_src == TRIG_TIMER) {
1559                 if (cmd->convert_arg < 125000) {
1560                         cmd->convert_arg = 125000;
1561                         err++;
1562                 }
1563         }
1564
1565         /* the same argument */
1566         if (cmd->scan_end_arg != cmd->chanlist_len) {
1567                 cmd->scan_end_arg = cmd->chanlist_len;
1568                 err++;
1569         }
1570
1571         if (cmd->stop_src == TRIG_COUNT) {
1572                 /* any count is allowed */
1573         } else {
1574                 /* TRIG_NONE */
1575                 if (cmd->stop_arg != 0) {
1576                         cmd->stop_arg = 0;
1577                         err++;
1578                 }
1579         }
1580
1581         dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: err=%d, "
1582                 "scan_begin_src=%d, scan_begin_arg=%d, convert_src=%d, "
1583                 "convert_arg=%d\n", dev->minor, err, cmd->scan_begin_src,
1584                 cmd->scan_begin_arg, cmd->convert_src, cmd->convert_arg);
1585
1586         if (err)
1587                 return 3;
1588
1589         return 0;
1590 }
1591
1592 static int usbdux_ao_cmd(struct comedi_device *dev, struct comedi_subdevice *s)
1593 {
1594         struct comedi_cmd *cmd = &s->async->cmd;
1595         unsigned int chan, gain;
1596         int i, ret;
1597         struct usbduxsub *this_usbduxsub = dev->private;
1598
1599         if (!this_usbduxsub)
1600                 return -EFAULT;
1601
1602         down(&this_usbduxsub->sem);
1603         if (!(this_usbduxsub->probed)) {
1604                 up(&this_usbduxsub->sem);
1605                 return -ENODEV;
1606         }
1607         dev_dbg(&this_usbduxsub->interface->dev,
1608                 "comedi%d: %s\n", dev->minor, __func__);
1609
1610         /* set current channel of the running aquisition to zero */
1611         s->async->cur_chan = 0;
1612         for (i = 0; i < cmd->chanlist_len; ++i) {
1613                 chan = CR_CHAN(cmd->chanlist[i]);
1614                 gain = CR_RANGE(cmd->chanlist[i]);
1615                 if (i >= NUMOUTCHANNELS) {
1616                         dev_err(&this_usbduxsub->interface->dev,
1617                                 "comedi%d: %s: channel list too long\n",
1618                                 dev->minor, __func__);
1619                         break;
1620                 }
1621                 this_usbduxsub->dac_commands[i] = (chan << 6);
1622                 dev_dbg(&this_usbduxsub->interface->dev,
1623                         "comedi%d: dac command for ch %d is %x\n",
1624                         dev->minor, i, this_usbduxsub->dac_commands[i]);
1625         }
1626
1627         /* we count in steps of 1ms (125us) */
1628         /* 125us mode not used yet */
1629         if (0) {                /* (this_usbduxsub->high_speed) */
1630                 /* 125us */
1631                 /* timing of the conversion itself: every 125 us */
1632                 this_usbduxsub->ao_timer = cmd->convert_arg / 125000;
1633         } else {
1634                 /* 1ms */
1635                 /* timing of the scan: we get all channels at once */
1636                 this_usbduxsub->ao_timer = cmd->scan_begin_arg / 1000000;
1637                 dev_dbg(&this_usbduxsub->interface->dev,
1638                         "comedi%d: scan_begin_src=%d, scan_begin_arg=%d, "
1639                         "convert_src=%d, convert_arg=%d\n", dev->minor,
1640                         cmd->scan_begin_src, cmd->scan_begin_arg,
1641                         cmd->convert_src, cmd->convert_arg);
1642                 dev_dbg(&this_usbduxsub->interface->dev,
1643                         "comedi%d: ao_timer=%d (ms)\n",
1644                         dev->minor, this_usbduxsub->ao_timer);
1645                 if (this_usbduxsub->ao_timer < 1) {
1646                         dev_err(&this_usbduxsub->interface->dev,
1647                                 "comedi%d: usbdux: ao_timer=%d, "
1648                                 "scan_begin_arg=%d. "
1649                                 "Not properly tested by cmdtest?\n",
1650                                 dev->minor, this_usbduxsub->ao_timer,
1651                                 cmd->scan_begin_arg);
1652                         up(&this_usbduxsub->sem);
1653                         return -EINVAL;
1654                 }
1655         }
1656         this_usbduxsub->ao_counter = this_usbduxsub->ao_timer;
1657
1658         if (cmd->stop_src == TRIG_COUNT) {
1659                 /* not continous */
1660                 /* counter */
1661                 /* high speed also scans everything at once */
1662                 if (0) {        /* (this_usbduxsub->high_speed) */
1663                         this_usbduxsub->ao_sample_count =
1664                                 (cmd->stop_arg) * (cmd->scan_end_arg);
1665                 } else {
1666                         /* there's no scan as the scan has been */
1667                         /* perf inside the FX2 */
1668                         /* data arrives as one packet */
1669                         this_usbduxsub->ao_sample_count = cmd->stop_arg;
1670                 }
1671                 this_usbduxsub->ao_continous = 0;
1672         } else {
1673                 /* continous aquisition */
1674                 this_usbduxsub->ao_continous = 1;
1675                 this_usbduxsub->ao_sample_count = 0;
1676         }
1677
1678         if (cmd->start_src == TRIG_NOW) {
1679                 /* enable this acquisition operation */
1680                 this_usbduxsub->ao_cmd_running = 1;
1681                 ret = usbduxsub_submit_OutURBs(this_usbduxsub);
1682                 if (ret < 0) {
1683                         this_usbduxsub->ao_cmd_running = 0;
1684                         /* fixme: unlink here?? */
1685                         up(&this_usbduxsub->sem);
1686                         return ret;
1687                 }
1688                 s->async->inttrig = NULL;
1689         } else {
1690                 /* TRIG_INT */
1691                 /* submit the urbs later */
1692                 /* wait for an internal signal */
1693                 s->async->inttrig = usbdux_ao_inttrig;
1694         }
1695
1696         up(&this_usbduxsub->sem);
1697         return 0;
1698 }
1699
1700 static int usbdux_dio_insn_config(struct comedi_device *dev, struct comedi_subdevice *s,
1701                                   struct comedi_insn *insn, unsigned int *data)
1702 {
1703         int chan = CR_CHAN(insn->chanspec);
1704
1705         /* The input or output configuration of each digital line is
1706          * configured by a special insn_config instruction.  chanspec
1707          * contains the channel to be changed, and data[0] contains the
1708          * value COMEDI_INPUT or COMEDI_OUTPUT. */
1709
1710         switch (data[0]) {
1711         case INSN_CONFIG_DIO_OUTPUT:
1712                 s->io_bits |= 1 << chan;        /* 1 means Out */
1713                 break;
1714         case INSN_CONFIG_DIO_INPUT:
1715                 s->io_bits &= ~(1 << chan);
1716                 break;
1717         case INSN_CONFIG_DIO_QUERY:
1718                 data[1] =
1719                         (s->
1720                         io_bits & (1 << chan)) ? COMEDI_OUTPUT : COMEDI_INPUT;
1721                 break;
1722         default:
1723                 return -EINVAL;
1724                 break;
1725         }
1726         /* we don't tell the firmware here as it would take 8 frames */
1727         /* to submit the information. We do it in the insn_bits. */
1728         return insn->n;
1729 }
1730
1731 static int usbdux_dio_insn_bits(struct comedi_device *dev, struct comedi_subdevice *s,
1732                                 struct comedi_insn *insn, unsigned int *data)
1733 {
1734
1735         struct usbduxsub *this_usbduxsub = dev->private;
1736         int err;
1737
1738         if (!this_usbduxsub)
1739                 return -EFAULT;
1740
1741
1742         if (insn->n != 2)
1743                 return -EINVAL;
1744
1745         down(&this_usbduxsub->sem);
1746
1747         if (!(this_usbduxsub->probed)) {
1748                 up(&this_usbduxsub->sem);
1749                 return -ENODEV;
1750         }
1751
1752         /* The insn data is a mask in data[0] and the new data
1753          * in data[1], each channel cooresponding to a bit. */
1754         s->state &= ~data[0];
1755         s->state |= data[0] & data[1];
1756         this_usbduxsub->dux_commands[1] = s->io_bits;
1757         this_usbduxsub->dux_commands[2] = s->state;
1758
1759         /* This command also tells the firmware to return */
1760         /* the digital input lines */
1761         err = send_dux_commands(this_usbduxsub, SENDDIOBITSCOMMAND);
1762         if (err < 0) {
1763                 up(&this_usbduxsub->sem);
1764                 return err;
1765         }
1766         err = receive_dux_commands(this_usbduxsub, SENDDIOBITSCOMMAND);
1767         if (err < 0) {
1768                 up(&this_usbduxsub->sem);
1769                 return err;
1770         }
1771
1772         data[1] = le16_to_cpu(this_usbduxsub->insnBuffer[1]);
1773         up(&this_usbduxsub->sem);
1774         return 2;
1775 }
1776
1777 /* reads the 4 counters, only two are used just now */
1778 static int usbdux_counter_read(struct comedi_device *dev, struct comedi_subdevice *s,
1779                                struct comedi_insn *insn, unsigned int *data)
1780 {
1781         struct usbduxsub *this_usbduxsub = dev->private;
1782         int chan = insn->chanspec;
1783         int err;
1784
1785         if (!this_usbduxsub)
1786                 return -EFAULT;
1787
1788         down(&this_usbduxsub->sem);
1789
1790         if (!(this_usbduxsub->probed)) {
1791                 up(&this_usbduxsub->sem);
1792                 return -ENODEV;
1793         }
1794
1795         err = send_dux_commands(this_usbduxsub, READCOUNTERCOMMAND);
1796         if (err < 0) {
1797                 up(&this_usbduxsub->sem);
1798                 return err;
1799         }
1800
1801         err = receive_dux_commands(this_usbduxsub, READCOUNTERCOMMAND);
1802         if (err < 0) {
1803                 up(&this_usbduxsub->sem);
1804                 return err;
1805         }
1806
1807         data[0] = le16_to_cpu(this_usbduxsub->insnBuffer[chan + 1]);
1808         up(&this_usbduxsub->sem);
1809         return 1;
1810 }
1811
1812 static int usbdux_counter_write(struct comedi_device *dev, struct comedi_subdevice *s,
1813                                 struct comedi_insn *insn, unsigned int *data)
1814 {
1815         struct usbduxsub *this_usbduxsub = dev->private;
1816         int err;
1817
1818         if (!this_usbduxsub)
1819                 return -EFAULT;
1820
1821         down(&this_usbduxsub->sem);
1822
1823         if (!(this_usbduxsub->probed)) {
1824                 up(&this_usbduxsub->sem);
1825                 return -ENODEV;
1826         }
1827
1828         this_usbduxsub->dux_commands[1] = insn->chanspec;
1829         *((int16_t *) (this_usbduxsub->dux_commands + 2)) = cpu_to_le16(*data);
1830
1831         err = send_dux_commands(this_usbduxsub, WRITECOUNTERCOMMAND);
1832         if (err < 0) {
1833                 up(&this_usbduxsub->sem);
1834                 return err;
1835         }
1836
1837         up(&this_usbduxsub->sem);
1838
1839         return 1;
1840 }
1841
1842 static int usbdux_counter_config(struct comedi_device *dev, struct comedi_subdevice *s,
1843                                  struct comedi_insn *insn, unsigned int *data)
1844 {
1845         /* nothing to do so far */
1846         return 2;
1847 }
1848
1849 /***********************************/
1850 /* PWM */
1851
1852 static int usbduxsub_unlink_PwmURBs(struct usbduxsub *usbduxsub_tmp)
1853 {
1854         int err = 0;
1855
1856         if (usbduxsub_tmp && usbduxsub_tmp->urbPwm) {
1857                 if (usbduxsub_tmp->urbPwm)
1858                         usb_kill_urb(usbduxsub_tmp->urbPwm);
1859                 dev_dbg(&usbduxsub_tmp->interface->dev,
1860                         "comedi: unlinked PwmURB: res=%d\n", err);
1861         }
1862         return err;
1863 }
1864
1865 /* This cancels a running acquisition operation
1866  * in any context.
1867  */
1868 static int usbdux_pwm_stop(struct usbduxsub *this_usbduxsub, int do_unlink)
1869 {
1870         int ret = 0;
1871
1872         if (!this_usbduxsub)
1873                 return -EFAULT;
1874
1875         dev_dbg(&this_usbduxsub->interface->dev, "comedi: %s\n", __func__);
1876         if (do_unlink)
1877                 ret = usbduxsub_unlink_PwmURBs(this_usbduxsub);
1878
1879
1880         this_usbduxsub->pwm_cmd_running = 0;
1881
1882         return ret;
1883 }
1884
1885 /* force unlink - is called by comedi */
1886 static int usbdux_pwm_cancel(struct comedi_device *dev, struct comedi_subdevice *s)
1887 {
1888         struct usbduxsub *this_usbduxsub = dev->private;
1889         int res = 0;
1890
1891         /* unlink only if it is really running */
1892         res = usbdux_pwm_stop(this_usbduxsub, this_usbduxsub->pwm_cmd_running);
1893
1894         dev_dbg(&this_usbduxsub->interface->dev,
1895                 "comedi %d: sending pwm off command to the usb device.\n",
1896                 dev->minor);
1897         res = send_dux_commands(this_usbduxsub, SENDPWMOFF);
1898         if (res < 0)
1899                 return res;
1900
1901         return res;
1902 }
1903
1904 static void usbduxsub_pwm_irq(struct urb *urb)
1905 {
1906         int ret;
1907         struct usbduxsub *this_usbduxsub;
1908         struct comedi_device *this_comedidev;
1909         struct comedi_subdevice *s;
1910
1911         /* printk(KERN_DEBUG "PWM: IRQ\n"); */
1912
1913         /* the context variable points to the subdevice */
1914         this_comedidev = urb->context;
1915         /* the private structure of the subdevice is struct usbduxsub */
1916         this_usbduxsub = this_comedidev->private;
1917
1918         s = this_comedidev->subdevices + SUBDEV_DA;
1919
1920         switch (urb->status) {
1921         case 0:
1922                 /* success */
1923                 break;
1924
1925         case -ECONNRESET:
1926         case -ENOENT:
1927         case -ESHUTDOWN:
1928         case -ECONNABORTED:
1929                 /*
1930                  * after an unlink command, unplug, ... etc
1931                  * no unlink needed here. Already shutting down.
1932                  */
1933                 if (this_usbduxsub->pwm_cmd_running)
1934                         usbdux_pwm_stop(this_usbduxsub, 0);
1935
1936                 return;
1937
1938         default:
1939                 /* a real error */
1940                 if (this_usbduxsub->pwm_cmd_running) {
1941                         dev_err(&this_usbduxsub->interface->dev,
1942                                 "comedi_: Non-zero urb status received in "
1943                                 "pwm intr context: %d\n", urb->status);
1944                         usbdux_pwm_stop(this_usbduxsub, 0);
1945                 }
1946                 return;
1947         }
1948
1949         /* are we actually running? */
1950         if (!(this_usbduxsub->pwm_cmd_running))
1951                 return;
1952
1953         urb->transfer_buffer_length = this_usbduxsub->sizePwmBuf;
1954         urb->dev = this_usbduxsub->usbdev;
1955         urb->status = 0;
1956         if (this_usbduxsub->pwm_cmd_running) {
1957                 ret = usb_submit_urb(urb, GFP_ATOMIC);
1958                 if (ret < 0) {
1959                         dev_err(&this_usbduxsub->interface->dev,
1960                                 "comedi_: pwm urb resubm failed in int-cont. "
1961                                 "ret=%d", ret);
1962                         if (ret == EL2NSYNC)
1963                                 dev_err(&this_usbduxsub->interface->dev,
1964                                         "buggy USB host controller or bug in "
1965                                         "IRQ handling!\n");
1966
1967                         /* don't do an unlink here */
1968                         usbdux_pwm_stop(this_usbduxsub, 0);
1969                 }
1970         }
1971 }
1972
1973 static int usbduxsub_submit_PwmURBs(struct usbduxsub *usbduxsub)
1974 {
1975         int errFlag;
1976
1977         if (!usbduxsub)
1978                 return -EFAULT;
1979
1980         dev_dbg(&usbduxsub->interface->dev, "comedi_: submitting pwm-urb\n");
1981
1982         /* in case of a resubmission after an unlink... */
1983         usb_fill_bulk_urb(usbduxsub->urbPwm,
1984                 usbduxsub->usbdev,
1985                 usb_sndbulkpipe(usbduxsub->usbdev, PWM_EP),
1986                 usbduxsub->urbPwm->transfer_buffer,
1987                 usbduxsub->sizePwmBuf, usbduxsub_pwm_irq, usbduxsub->comedidev);
1988
1989         errFlag = usb_submit_urb(usbduxsub->urbPwm, GFP_ATOMIC);
1990         if (errFlag) {
1991                 dev_err(&usbduxsub->interface->dev,
1992                         "comedi_: usbdux: pwm: usb_submit_urb error %d\n",
1993                         errFlag);
1994                 return errFlag;
1995         }
1996         return 0;
1997 }
1998
1999 static int usbdux_pwm_period(struct comedi_device *dev, struct comedi_subdevice *s,
2000                              unsigned int period)
2001 {
2002         struct usbduxsub *this_usbduxsub = dev->private;
2003         int fx2delay = 255;
2004
2005         if (period < MIN_PWM_PERIOD) {
2006                 dev_err(&this_usbduxsub->interface->dev,
2007                         "comedi%d: illegal period setting for pwm.\n",
2008                         dev->minor);
2009                 return -EAGAIN;
2010         } else {
2011                 fx2delay = period / ((int)(6*512*(1.0/0.033))) - 6;
2012                 if (fx2delay > 255) {
2013                         dev_err(&this_usbduxsub->interface->dev,
2014                                 "comedi%d: period %d for pwm is too low.\n",
2015                                dev->minor, period);
2016                         return -EAGAIN;
2017                 }
2018         }
2019         this_usbduxsub->pwmDelay = fx2delay;
2020         this_usbduxsub->pwmPeriod = period;
2021         dev_dbg(&this_usbduxsub->interface->dev, "%s: frequ=%d, period=%d\n",
2022                 __func__, period, fx2delay);
2023         return 0;
2024 }
2025
2026 /* is called from insn so there's no need to do all the sanity checks */
2027 static int usbdux_pwm_start(struct comedi_device *dev, struct comedi_subdevice *s)
2028 {
2029         int ret, i;
2030         struct usbduxsub *this_usbduxsub = dev->private;
2031
2032         dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: %s\n",
2033                 dev->minor, __func__);
2034
2035         if (this_usbduxsub->pwm_cmd_running) {
2036                 /* already running */
2037                 return 0;
2038         }
2039
2040         this_usbduxsub->dux_commands[1] = ((int8_t) this_usbduxsub->pwmDelay);
2041         ret = send_dux_commands(this_usbduxsub, SENDPWMON);
2042         if (ret < 0)
2043                 return ret;
2044
2045         /* initalise the buffer */
2046         for (i = 0; i < this_usbduxsub->sizePwmBuf; i++)
2047                 ((char *)(this_usbduxsub->urbPwm->transfer_buffer))[i] = 0;
2048
2049         this_usbduxsub->pwm_cmd_running = 1;
2050         ret = usbduxsub_submit_PwmURBs(this_usbduxsub);
2051         if (ret < 0) {
2052                 this_usbduxsub->pwm_cmd_running = 0;
2053                 return ret;
2054         }
2055         return 0;
2056 }
2057
2058 /* generates the bit pattern for PWM with the optional sign bit */
2059 static int usbdux_pwm_pattern(struct comedi_device *dev, struct comedi_subdevice *s,
2060                               int channel, unsigned int value, unsigned int sign)
2061 {
2062         struct usbduxsub *this_usbduxsub = dev->private;
2063         int i, szbuf;
2064         char *pBuf;
2065         char pwm_mask;
2066         char sgn_mask;
2067         char c;
2068
2069         if (!this_usbduxsub)
2070                 return -EFAULT;
2071
2072         /* this is the DIO bit which carries the PWM data */
2073         pwm_mask = (1 << channel);
2074         /* this is the DIO bit which carries the optional direction bit */
2075         sgn_mask = (16 << channel);
2076         /* this is the buffer which will be filled with the with bit */
2077         /* pattern for one period */
2078         szbuf = this_usbduxsub->sizePwmBuf;
2079         pBuf = (char *)(this_usbduxsub->urbPwm->transfer_buffer);
2080         for (i = 0; i < szbuf; i++) {
2081                 c = *pBuf;
2082                 /* reset bits */
2083                 c = c & (~pwm_mask);
2084                 /* set the bit as long as the index is lower than the value */
2085                 if (i < value)
2086                         c = c | pwm_mask;
2087                 /* set the optional sign bit for a relay */
2088                 if (!sign) {
2089                         /* positive value */
2090                         c = c & (~sgn_mask);
2091                 } else {
2092                         /* negative value */
2093                         c = c | sgn_mask;
2094                 }
2095                 *(pBuf++) = c;
2096         }
2097         return 1;
2098 }
2099
2100 static int usbdux_pwm_write(struct comedi_device *dev, struct comedi_subdevice *s,
2101                             struct comedi_insn *insn, unsigned int *data)
2102 {
2103         struct usbduxsub *this_usbduxsub = dev->private;
2104
2105         if (!this_usbduxsub)
2106                 return -EFAULT;
2107
2108         if ((insn->n) != 1) {
2109                 /*
2110                  * doesn't make sense to have more than one value here because
2111                  * it would just overwrite the PWM buffer a couple of times
2112                  */
2113                 return -EINVAL;
2114         }
2115
2116         /*
2117          * the sign is set via a special INSN only, this gives us 8 bits for
2118          * normal operation
2119          * relay sign 0 by default
2120          */
2121         return usbdux_pwm_pattern(dev, s, CR_CHAN(insn->chanspec),
2122                                   data[0], 0);
2123 }
2124
2125 static int usbdux_pwm_read(struct comedi_device *x1, struct comedi_subdevice *x2,
2126                            struct comedi_insn *x3, unsigned int *x4)
2127 {
2128         /* not needed */
2129         return -EINVAL;
2130 };
2131
2132 /* switches on/off PWM */
2133 static int usbdux_pwm_config(struct comedi_device *dev, struct comedi_subdevice *s,
2134                              struct comedi_insn *insn, unsigned int *data)
2135 {
2136         struct usbduxsub *this_usbduxsub = dev->private;
2137         switch (data[0]) {
2138         case INSN_CONFIG_ARM:
2139                 /* switch it on */
2140                 dev_dbg(&this_usbduxsub->interface->dev,
2141                         "comedi%d: %s: pwm on\n", dev->minor, __func__);
2142                 /*
2143                  * if not zero the PWM is limited to a certain time which is
2144                  * not supported here
2145                  */
2146                 if (data[1] != 0)
2147                         return -EINVAL;
2148                 return usbdux_pwm_start(dev, s);
2149         case INSN_CONFIG_DISARM:
2150                 dev_dbg(&this_usbduxsub->interface->dev,
2151                         "comedi%d: %s: pwm off\n", dev->minor, __func__);
2152                 return usbdux_pwm_cancel(dev, s);
2153         case INSN_CONFIG_GET_PWM_STATUS:
2154                 /*
2155                  * to check if the USB transmission has failed or in case PWM
2156                  * was limited to n cycles to check if it has terminated
2157                  */
2158                 data[1] = this_usbduxsub->pwm_cmd_running;
2159                 return 0;
2160         case INSN_CONFIG_PWM_SET_PERIOD:
2161                 dev_dbg(&this_usbduxsub->interface->dev,
2162                         "comedi%d: %s: setting period\n", dev->minor, __func__);
2163                 return usbdux_pwm_period(dev, s, data[1]);
2164         case INSN_CONFIG_PWM_GET_PERIOD:
2165                 data[1] = this_usbduxsub->pwmPeriod;
2166                 return 0;
2167         case INSN_CONFIG_PWM_SET_H_BRIDGE:
2168                 /* value in the first byte and the sign in the second for a
2169                    relay */
2170                 return usbdux_pwm_pattern(dev, s,
2171                                           /* the channel number */
2172                                           CR_CHAN(insn->chanspec),
2173                                           /* actual PWM data */
2174                                           data[1],
2175                                           /* just a sign */
2176                                           (data[2] != 0));
2177         case INSN_CONFIG_PWM_GET_H_BRIDGE:
2178                 /* values are not kept in this driver, nothing to return here */
2179                 return -EINVAL;
2180         }
2181         return -EINVAL;
2182 }
2183
2184 /* end of PWM */
2185 /*****************************************************************/
2186
2187 static void tidy_up(struct usbduxsub *usbduxsub_tmp)
2188 {
2189         int i;
2190
2191         if (!usbduxsub_tmp)
2192                 return;
2193         dev_dbg(&usbduxsub_tmp->interface->dev, "comedi_: tiding up\n");
2194
2195         /* shows the usb subsystem that the driver is down */
2196         if (usbduxsub_tmp->interface)
2197                 usb_set_intfdata(usbduxsub_tmp->interface, NULL);
2198
2199         usbduxsub_tmp->probed = 0;
2200
2201         if (usbduxsub_tmp->urbIn) {
2202                 if (usbduxsub_tmp->ai_cmd_running) {
2203                         usbduxsub_tmp->ai_cmd_running = 0;
2204                         usbduxsub_unlink_InURBs(usbduxsub_tmp);
2205                 }
2206                 for (i = 0; i < usbduxsub_tmp->numOfInBuffers; i++) {
2207                         kfree(usbduxsub_tmp->urbIn[i]->transfer_buffer);
2208                         usbduxsub_tmp->urbIn[i]->transfer_buffer = NULL;
2209                         usb_kill_urb(usbduxsub_tmp->urbIn[i]);
2210                         usb_free_urb(usbduxsub_tmp->urbIn[i]);
2211                         usbduxsub_tmp->urbIn[i] = NULL;
2212                 }
2213                 kfree(usbduxsub_tmp->urbIn);
2214                 usbduxsub_tmp->urbIn = NULL;
2215         }
2216         if (usbduxsub_tmp->urbOut) {
2217                 if (usbduxsub_tmp->ao_cmd_running) {
2218                         usbduxsub_tmp->ao_cmd_running = 0;
2219                         usbduxsub_unlink_OutURBs(usbduxsub_tmp);
2220                 }
2221                 for (i = 0; i < usbduxsub_tmp->numOfOutBuffers; i++) {
2222                         if (usbduxsub_tmp->urbOut[i]->transfer_buffer) {
2223                                 kfree(usbduxsub_tmp->urbOut[i]->
2224                                         transfer_buffer);
2225                                 usbduxsub_tmp->urbOut[i]->transfer_buffer =
2226                                         NULL;
2227                         }
2228                         if (usbduxsub_tmp->urbOut[i]) {
2229                                 usb_kill_urb(usbduxsub_tmp->urbOut[i]);
2230                                 usb_free_urb(usbduxsub_tmp->urbOut[i]);
2231                                 usbduxsub_tmp->urbOut[i] = NULL;
2232                         }
2233                 }
2234                 kfree(usbduxsub_tmp->urbOut);
2235                 usbduxsub_tmp->urbOut = NULL;
2236         }
2237         if (usbduxsub_tmp->urbPwm) {
2238                 if (usbduxsub_tmp->pwm_cmd_running) {
2239                         usbduxsub_tmp->pwm_cmd_running = 0;
2240                         usbduxsub_unlink_PwmURBs(usbduxsub_tmp);
2241                 }
2242                 kfree(usbduxsub_tmp->urbPwm->transfer_buffer);
2243                 usbduxsub_tmp->urbPwm->transfer_buffer = NULL;
2244                 usb_kill_urb(usbduxsub_tmp->urbPwm);
2245                 usb_free_urb(usbduxsub_tmp->urbPwm);
2246                 usbduxsub_tmp->urbPwm = NULL;
2247         }
2248         kfree(usbduxsub_tmp->inBuffer);
2249         usbduxsub_tmp->inBuffer = NULL;
2250         kfree(usbduxsub_tmp->insnBuffer);
2251         usbduxsub_tmp->insnBuffer = NULL;
2252         kfree(usbduxsub_tmp->inBuffer);
2253         usbduxsub_tmp->inBuffer = NULL;
2254         kfree(usbduxsub_tmp->dac_commands);
2255         usbduxsub_tmp->dac_commands = NULL;
2256         kfree(usbduxsub_tmp->dux_commands);
2257         usbduxsub_tmp->dux_commands = NULL;
2258         usbduxsub_tmp->ai_cmd_running = 0;
2259         usbduxsub_tmp->ao_cmd_running = 0;
2260         usbduxsub_tmp->pwm_cmd_running = 0;
2261 }
2262
2263 static unsigned hex2unsigned(char *h)
2264 {
2265         unsigned hi, lo;
2266
2267         if (h[0] > '9')
2268                 hi = h[0] - 'A' + 0x0a;
2269         else
2270                 hi = h[0] - '0';
2271
2272         if (h[1] > '9')
2273                 lo = h[1] - 'A' + 0x0a;
2274         else
2275                 lo = h[1] - '0';
2276
2277         return hi * 0x10 + lo;
2278 }
2279
2280 /* for FX2 */
2281 #define FIRMWARE_MAX_LEN 0x2000
2282
2283 /* taken from David Brownell's fxload and adjusted for this driver */
2284 static int read_firmware(struct usbduxsub *usbduxsub, const void *firmwarePtr,
2285                          long size)
2286 {
2287         struct device *dev = &usbduxsub->interface->dev;
2288         int i = 0;
2289         unsigned char *fp = (char *)firmwarePtr;
2290         unsigned char *firmwareBinary;
2291         int res = 0;
2292         int maxAddr = 0;
2293
2294         firmwareBinary = kzalloc(FIRMWARE_MAX_LEN, GFP_KERNEL);
2295         if (!firmwareBinary) {
2296                 dev_err(dev, "comedi_: mem alloc for firmware failed\n");
2297                 return -ENOMEM;
2298         }
2299
2300         for (;;) {
2301                 char buf[256], *cp;
2302                 char type;
2303                 int len;
2304                 int idx, off;
2305                 int j = 0;
2306
2307                 /* get one line */
2308                 while ((i < size) && (fp[i] != 13) && (fp[i] != 10)) {
2309                         buf[j] = fp[i];
2310                         i++;
2311                         j++;
2312                         if (j >= sizeof(buf)) {
2313                                 dev_err(dev, "comedi_: bogus firmware file!\n");
2314                                 kfree(firmwareBinary);
2315                                 return -1;
2316                         }
2317                 }
2318                 /* get rid of LF/CR/... */
2319                 while ((i < size) && ((fp[i] == 13) || (fp[i] == 10)
2320                                 || (fp[i] == 0))) {
2321                         i++;
2322                 }
2323
2324                 buf[j] = 0;
2325                 /* dev_dbg(dev, "comedi_: buf=%s\n", buf); */
2326
2327                 /*
2328                  * EXTENSION:
2329                  * "# comment-till-end-of-line", for copyrights etc
2330                  */
2331                 if (buf[0] == '#')
2332                         continue;
2333
2334                 if (buf[0] != ':') {
2335                         dev_err(dev, "comedi_: upload: not an ihex record: %s",
2336                                 buf);
2337                         kfree(firmwareBinary);
2338                         return -EFAULT;
2339                 }
2340
2341                 /* Read the length field (up to 16 bytes) */
2342                 len = hex2unsigned(buf + 1);
2343
2344                 /* Read the target offset */
2345                 off = (hex2unsigned(buf + 3) * 0x0100) + hex2unsigned(buf + 5);
2346
2347                 if ((off + len) > maxAddr)
2348                         maxAddr = off + len;
2349
2350
2351                 if (maxAddr >= FIRMWARE_MAX_LEN) {
2352                         dev_err(dev, "comedi_: firmware upload goes "
2353                                 "beyond FX2 RAM boundaries.\n");
2354                         kfree(firmwareBinary);
2355                         return -EFAULT;
2356                 }
2357                 /* dev_dbg(dev, "comedi_: off=%x, len=%x:\n", off, len); */
2358
2359                 /* Read the record type */
2360                 type = hex2unsigned(buf + 7);
2361
2362                 /* If this is an EOF record, then make it so. */
2363                 if (type == 1)
2364                         break;
2365
2366
2367                 if (type != 0) {
2368                         dev_err(dev, "comedi_: unsupported record type: %u\n",
2369                                 type);
2370                         kfree(firmwareBinary);
2371                         return -EFAULT;
2372                 }
2373
2374                 for (idx = 0, cp = buf + 9; idx < len; idx += 1, cp += 2) {
2375                         firmwareBinary[idx + off] = hex2unsigned(cp);
2376                         /*printk("%02x ",firmwareBinary[idx+off]); */
2377                 }
2378                 /*printk("\n"); */
2379
2380                 if (i >= size) {
2381                         dev_err(dev, "comedi_: unexpected end of hex file\n");
2382                         break;
2383                 }
2384
2385         }
2386         res = firmwareUpload(usbduxsub, firmwareBinary, maxAddr + 1);
2387         kfree(firmwareBinary);
2388         return res;
2389 }
2390
2391 static void usbdux_firmware_request_complete_handler(const struct firmware *fw,
2392                                                      void *context)
2393 {
2394         struct usbduxsub *usbduxsub_tmp = context;
2395         struct usb_device *usbdev = usbduxsub_tmp->usbdev;
2396         int ret;
2397
2398         if (fw == NULL) {
2399                 dev_err(&usbdev->dev,
2400                         "Firmware complete handler without firmware!\n");
2401                 return;
2402         }
2403
2404         /*
2405          * we need to upload the firmware here because fw will be
2406          * freed once we've left this function
2407          */
2408         ret = read_firmware(usbduxsub_tmp, fw->data, fw->size);
2409
2410         if (ret) {
2411                 dev_err(&usbdev->dev,
2412                         "Could not upload firmware (err=%d)\n",
2413                         ret);
2414                 return;
2415         }
2416         comedi_usb_auto_config(usbdev, BOARDNAME);
2417 }
2418
2419 /* allocate memory for the urbs and initialise them */
2420 static int usbduxsub_probe(struct usb_interface *uinterf,
2421                            const struct usb_device_id *id)
2422 {
2423         struct usb_device *udev = interface_to_usbdev(uinterf);
2424         struct device *dev = &uinterf->dev;
2425         int i;
2426         int index;
2427         int ret;
2428
2429         dev_dbg(dev, "comedi_: usbdux_: "
2430                 "finding a free structure for the usb-device\n");
2431
2432         down(&start_stop_sem);
2433         /* look for a free place in the usbdux array */
2434         index = -1;
2435         for (i = 0; i < NUMUSBDUX; i++) {
2436                 if (!(usbduxsub[i].probed)) {
2437                         index = i;
2438                         break;
2439                 }
2440         }
2441
2442         /* no more space */
2443         if (index == -1) {
2444                 dev_err(dev, "Too many usbdux-devices connected.\n");
2445                 up(&start_stop_sem);
2446                 return -EMFILE;
2447         }
2448         dev_dbg(dev, "comedi_: usbdux: "
2449                 "usbduxsub[%d] is ready to connect to comedi.\n", index);
2450
2451         init_MUTEX(&(usbduxsub[index].sem));
2452         /* save a pointer to the usb device */
2453         usbduxsub[index].usbdev = udev;
2454
2455         /* 2.6: save the interface itself */
2456         usbduxsub[index].interface = uinterf;
2457         /* get the interface number from the interface */
2458         usbduxsub[index].ifnum = uinterf->altsetting->desc.bInterfaceNumber;
2459         /* hand the private data over to the usb subsystem */
2460         /* will be needed for disconnect */
2461         usb_set_intfdata(uinterf, &(usbduxsub[index]));
2462
2463         dev_dbg(dev, "comedi_: usbdux: ifnum=%d\n", usbduxsub[index].ifnum);
2464
2465         /* test if it is high speed (USB 2.0) */
2466         usbduxsub[index].high_speed =
2467                 (usbduxsub[index].usbdev->speed == USB_SPEED_HIGH);
2468
2469         /* create space for the commands of the DA converter */
2470         usbduxsub[index].dac_commands = kzalloc(NUMOUTCHANNELS, GFP_KERNEL);
2471         if (!usbduxsub[index].dac_commands) {
2472                 dev_err(dev, "comedi_: usbdux: "
2473                         "error alloc space for dac commands\n");
2474                 tidy_up(&(usbduxsub[index]));
2475                 up(&start_stop_sem);
2476                 return -ENOMEM;
2477         }
2478         /* create space for the commands going to the usb device */
2479         usbduxsub[index].dux_commands = kzalloc(SIZEOFDUXBUFFER, GFP_KERNEL);
2480         if (!usbduxsub[index].dux_commands) {
2481                 dev_err(dev, "comedi_: usbdux: "
2482                         "error alloc space for dac commands\n");
2483                 tidy_up(&(usbduxsub[index]));
2484                 up(&start_stop_sem);
2485                 return -ENOMEM;
2486         }
2487         /* create space for the in buffer and set it to zero */
2488         usbduxsub[index].inBuffer = kzalloc(SIZEINBUF, GFP_KERNEL);
2489         if (!(usbduxsub[index].inBuffer)) {
2490                 dev_err(dev, "comedi_: usbdux: "
2491                         "could not alloc space for inBuffer\n");
2492                 tidy_up(&(usbduxsub[index]));
2493                 up(&start_stop_sem);
2494                 return -ENOMEM;
2495         }
2496         /* create space of the instruction buffer */
2497         usbduxsub[index].insnBuffer = kzalloc(SIZEINSNBUF, GFP_KERNEL);
2498         if (!(usbduxsub[index].insnBuffer)) {
2499                 dev_err(dev, "comedi_: usbdux: "
2500                         "could not alloc space for insnBuffer\n");
2501                 tidy_up(&(usbduxsub[index]));
2502                 up(&start_stop_sem);
2503                 return -ENOMEM;
2504         }
2505         /* create space for the outbuffer */
2506         usbduxsub[index].outBuffer = kzalloc(SIZEOUTBUF, GFP_KERNEL);
2507         if (!(usbduxsub[index].outBuffer)) {
2508                 dev_err(dev, "comedi_: usbdux: "
2509                         "could not alloc space for outBuffer\n");
2510                 tidy_up(&(usbduxsub[index]));
2511                 up(&start_stop_sem);
2512                 return -ENOMEM;
2513         }
2514         /* setting to alternate setting 3: enabling iso ep and bulk ep. */
2515         i = usb_set_interface(usbduxsub[index].usbdev,
2516                               usbduxsub[index].ifnum, 3);
2517         if (i < 0) {
2518                 dev_err(dev, "comedi_: usbdux%d: "
2519                         "could not set alternate setting 3 in high speed.\n",
2520                         index);
2521                 tidy_up(&(usbduxsub[index]));
2522                 up(&start_stop_sem);
2523                 return -ENODEV;
2524         }
2525         if (usbduxsub[index].high_speed)
2526                 usbduxsub[index].numOfInBuffers = NUMOFINBUFFERSHIGH;
2527         else
2528                 usbduxsub[index].numOfInBuffers = NUMOFINBUFFERSFULL;
2529
2530         usbduxsub[index].urbIn =
2531                 kzalloc(sizeof(struct urb *) * usbduxsub[index].numOfInBuffers,
2532                 GFP_KERNEL);
2533         if (!(usbduxsub[index].urbIn)) {
2534                 dev_err(dev, "comedi_: usbdux: Could not alloc. urbIn array\n");
2535                 tidy_up(&(usbduxsub[index]));
2536                 up(&start_stop_sem);
2537                 return -ENOMEM;
2538         }
2539         for (i = 0; i < usbduxsub[index].numOfInBuffers; i++) {
2540                 /* one frame: 1ms */
2541                 usbduxsub[index].urbIn[i] = usb_alloc_urb(1, GFP_KERNEL);
2542                 if (usbduxsub[index].urbIn[i] == NULL) {
2543                         dev_err(dev, "comedi_: usbdux%d: "
2544                                 "Could not alloc. urb(%d)\n", index, i);
2545                         tidy_up(&(usbduxsub[index]));
2546                         up(&start_stop_sem);
2547                         return -ENOMEM;
2548                 }
2549                 usbduxsub[index].urbIn[i]->dev = usbduxsub[index].usbdev;
2550                 /* will be filled later with a pointer to the comedi-device */
2551                 /* and ONLY then the urb should be submitted */
2552                 usbduxsub[index].urbIn[i]->context = NULL;
2553                 usbduxsub[index].urbIn[i]->pipe =
2554                         usb_rcvisocpipe(usbduxsub[index].usbdev, ISOINEP);
2555                 usbduxsub[index].urbIn[i]->transfer_flags = URB_ISO_ASAP;
2556                 usbduxsub[index].urbIn[i]->transfer_buffer =
2557                         kzalloc(SIZEINBUF, GFP_KERNEL);
2558                 if (!(usbduxsub[index].urbIn[i]->transfer_buffer)) {
2559                         dev_err(dev, "comedi_: usbdux%d: "
2560                                 "could not alloc. transb.\n", index);
2561                         tidy_up(&(usbduxsub[index]));
2562                         up(&start_stop_sem);
2563                         return -ENOMEM;
2564                 }
2565                 usbduxsub[index].urbIn[i]->complete = usbduxsub_ai_IsocIrq;
2566                 usbduxsub[index].urbIn[i]->number_of_packets = 1;
2567                 usbduxsub[index].urbIn[i]->transfer_buffer_length = SIZEINBUF;
2568                 usbduxsub[index].urbIn[i]->iso_frame_desc[0].offset = 0;
2569                 usbduxsub[index].urbIn[i]->iso_frame_desc[0].length = SIZEINBUF;
2570         }
2571
2572         /* out */
2573         if (usbduxsub[index].high_speed)
2574                 usbduxsub[index].numOfOutBuffers = NUMOFOUTBUFFERSHIGH;
2575         else
2576                 usbduxsub[index].numOfOutBuffers = NUMOFOUTBUFFERSFULL;
2577
2578         usbduxsub[index].urbOut =
2579                 kzalloc(sizeof(struct urb *) * usbduxsub[index].numOfOutBuffers,
2580                 GFP_KERNEL);
2581         if (!(usbduxsub[index].urbOut)) {
2582                 dev_err(dev, "comedi_: usbdux: "
2583                         "Could not alloc. urbOut array\n");
2584                 tidy_up(&(usbduxsub[index]));
2585                 up(&start_stop_sem);
2586                 return -ENOMEM;
2587         }
2588         for (i = 0; i < usbduxsub[index].numOfOutBuffers; i++) {
2589                 /* one frame: 1ms */
2590                 usbduxsub[index].urbOut[i] = usb_alloc_urb(1, GFP_KERNEL);
2591                 if (usbduxsub[index].urbOut[i] == NULL) {
2592                         dev_err(dev, "comedi_: usbdux%d: "
2593                                 "Could not alloc. urb(%d)\n", index, i);
2594                         tidy_up(&(usbduxsub[index]));
2595                         up(&start_stop_sem);
2596                         return -ENOMEM;
2597                 }
2598                 usbduxsub[index].urbOut[i]->dev = usbduxsub[index].usbdev;
2599                 /* will be filled later with a pointer to the comedi-device */
2600                 /* and ONLY then the urb should be submitted */
2601                 usbduxsub[index].urbOut[i]->context = NULL;
2602                 usbduxsub[index].urbOut[i]->pipe =
2603                         usb_sndisocpipe(usbduxsub[index].usbdev, ISOOUTEP);
2604                 usbduxsub[index].urbOut[i]->transfer_flags = URB_ISO_ASAP;
2605                 usbduxsub[index].urbOut[i]->transfer_buffer =
2606                         kzalloc(SIZEOUTBUF, GFP_KERNEL);
2607                 if (!(usbduxsub[index].urbOut[i]->transfer_buffer)) {
2608                         dev_err(dev, "comedi_: usbdux%d: "
2609                                 "could not alloc. transb.\n", index);
2610                         tidy_up(&(usbduxsub[index]));
2611                         up(&start_stop_sem);
2612                         return -ENOMEM;
2613                 }
2614                 usbduxsub[index].urbOut[i]->complete = usbduxsub_ao_IsocIrq;
2615                 usbduxsub[index].urbOut[i]->number_of_packets = 1;
2616                 usbduxsub[index].urbOut[i]->transfer_buffer_length = SIZEOUTBUF;
2617                 usbduxsub[index].urbOut[i]->iso_frame_desc[0].offset = 0;
2618                 usbduxsub[index].urbOut[i]->iso_frame_desc[0].length =
2619                         SIZEOUTBUF;
2620                 if (usbduxsub[index].high_speed) {
2621                         /* uframes */
2622                         usbduxsub[index].urbOut[i]->interval = 8;
2623                 } else {
2624                         /* frames */
2625                         usbduxsub[index].urbOut[i]->interval = 1;
2626                 }
2627         }
2628
2629         /* pwm */
2630         if (usbduxsub[index].high_speed) {
2631                 /* max bulk ep size in high speed */
2632                 usbduxsub[index].sizePwmBuf = 512;
2633                 usbduxsub[index].urbPwm = usb_alloc_urb(0, GFP_KERNEL);
2634                 if (usbduxsub[index].urbPwm == NULL) {
2635                         dev_err(dev, "comedi_: usbdux%d: "
2636                                 "Could not alloc. pwm urb\n", index);
2637                         tidy_up(&(usbduxsub[index]));
2638                         up(&start_stop_sem);
2639                         return -ENOMEM;
2640                 }
2641                 usbduxsub[index].urbPwm->transfer_buffer =
2642                         kzalloc(usbduxsub[index].sizePwmBuf, GFP_KERNEL);
2643                 if (!(usbduxsub[index].urbPwm->transfer_buffer)) {
2644                         dev_err(dev, "comedi_: usbdux%d: "
2645                                 "could not alloc. transb. for pwm\n", index);
2646                         tidy_up(&(usbduxsub[index]));
2647                         up(&start_stop_sem);
2648                         return -ENOMEM;
2649                 }
2650         } else {
2651                 usbduxsub[index].urbPwm = NULL;
2652                 usbduxsub[index].sizePwmBuf = 0;
2653         }
2654
2655         usbduxsub[index].ai_cmd_running = 0;
2656         usbduxsub[index].ao_cmd_running = 0;
2657         usbduxsub[index].pwm_cmd_running = 0;
2658
2659         /* we've reached the bottom of the function */
2660         usbduxsub[index].probed = 1;
2661         up(&start_stop_sem);
2662
2663         ret = request_firmware_nowait(THIS_MODULE,
2664                                       FW_ACTION_HOTPLUG,
2665                                       "usbdux_firmware.hex",
2666                                       &udev->dev,
2667                                       usbduxsub + index,
2668                                       usbdux_firmware_request_complete_handler);
2669
2670         if (ret) {
2671                 dev_err(dev, "Could not load firmware (err=%d)\n", ret);
2672                 return ret;
2673         }
2674
2675         dev_info(dev, "comedi_: usbdux%d "
2676                  "has been successfully initialised.\n", index);
2677         /* success */
2678         return 0;
2679 }
2680
2681 static void usbduxsub_disconnect(struct usb_interface *intf)
2682 {
2683         struct usbduxsub *usbduxsub_tmp = usb_get_intfdata(intf);
2684         struct usb_device *udev = interface_to_usbdev(intf);
2685
2686         if (!usbduxsub_tmp) {
2687                 dev_err(&intf->dev,
2688                         "comedi_: disconnect called with null pointer.\n");
2689                 return;
2690         }
2691         if (usbduxsub_tmp->usbdev != udev) {
2692                 dev_err(&intf->dev,
2693                         "comedi_: BUG! called with wrong ptr!!!\n");
2694                 return;
2695         }
2696         comedi_usb_auto_unconfig(udev);
2697         down(&start_stop_sem);
2698         down(&usbduxsub_tmp->sem);
2699         tidy_up(usbduxsub_tmp);
2700         up(&usbduxsub_tmp->sem);
2701         up(&start_stop_sem);
2702         dev_dbg(&intf->dev, "comedi_: disconnected from the usb\n");
2703 }
2704
2705 /* is called when comedi-config is called */
2706 static int usbdux_attach(struct comedi_device *dev, struct comedi_devconfig *it)
2707 {
2708         int ret;
2709         int index;
2710         int i;
2711         struct usbduxsub *udev;
2712
2713         struct comedi_subdevice *s = NULL;
2714         dev->private = NULL;
2715
2716         down(&start_stop_sem);
2717         /* find a valid device which has been detected by the probe function of
2718          * the usb */
2719         index = -1;
2720         for (i = 0; i < NUMUSBDUX; i++) {
2721                 if ((usbduxsub[i].probed) && (!usbduxsub[i].attached)) {
2722                         index = i;
2723                         break;
2724                 }
2725         }
2726
2727         if (index < 0) {
2728                 printk(KERN_ERR "comedi%d: usbdux: error: attach failed, no "
2729                        "usbdux devs connected to the usb bus.\n", dev->minor);
2730                 up(&start_stop_sem);
2731                 return -ENODEV;
2732         }
2733
2734         udev = &usbduxsub[index];
2735         down(&udev->sem);
2736         /* pointer back to the corresponding comedi device */
2737         udev->comedidev = dev;
2738
2739         /* trying to upload the firmware into the chip */
2740         if (comedi_aux_data(it->options, 0) &&
2741                 it->options[COMEDI_DEVCONF_AUX_DATA_LENGTH]) {
2742                 read_firmware(udev, comedi_aux_data(it->options, 0),
2743                               it->options[COMEDI_DEVCONF_AUX_DATA_LENGTH]);
2744         }
2745
2746         dev->board_name = BOARDNAME;
2747
2748         /* set number of subdevices */
2749         if (udev->high_speed) {
2750                 /* with pwm */
2751                 dev->n_subdevices = 5;
2752         } else {
2753                 /* without pwm */
2754                 dev->n_subdevices = 4;
2755         }
2756
2757         /* allocate space for the subdevices */
2758         ret = alloc_subdevices(dev, dev->n_subdevices);
2759         if (ret < 0) {
2760                 dev_err(&udev->interface->dev,
2761                         "comedi%d: error alloc space for subdev\n", dev->minor);
2762                 up(&start_stop_sem);
2763                 return ret;
2764         }
2765
2766         dev_info(&udev->interface->dev,
2767                 "comedi%d: usb-device %d is attached to comedi.\n",
2768                 dev->minor, index);
2769         /* private structure is also simply the usb-structure */
2770         dev->private = udev;
2771
2772         /* the first subdevice is the A/D converter */
2773         s = dev->subdevices + SUBDEV_AD;
2774         /* the URBs get the comedi subdevice */
2775         /* which is responsible for reading */
2776         /* this is the subdevice which reads data */
2777         dev->read_subdev = s;
2778         /* the subdevice receives as private structure the */
2779         /* usb-structure */
2780         s->private = NULL;
2781         /* analog input */
2782         s->type = COMEDI_SUBD_AI;
2783         /* readable and ref is to ground */
2784         s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_CMD_READ;
2785         /* 8 channels */
2786         s->n_chan = 8;
2787         /* length of the channellist */
2788         s->len_chanlist = 8;
2789         /* callback functions */
2790         s->insn_read = usbdux_ai_insn_read;
2791         s->do_cmdtest = usbdux_ai_cmdtest;
2792         s->do_cmd = usbdux_ai_cmd;
2793         s->cancel = usbdux_ai_cancel;
2794         /* max value from the A/D converter (12bit) */
2795         s->maxdata = 0xfff;
2796         /* range table to convert to physical units */
2797         s->range_table = (&range_usbdux_ai_range);
2798
2799         /* analog out */
2800         s = dev->subdevices + SUBDEV_DA;
2801         /* analog out */
2802         s->type = COMEDI_SUBD_AO;
2803         /* backward pointer */
2804         dev->write_subdev = s;
2805         /* the subdevice receives as private structure the */
2806         /* usb-structure */
2807         s->private = NULL;
2808         /* are writable */
2809         s->subdev_flags = SDF_WRITABLE | SDF_GROUND | SDF_CMD_WRITE;
2810         /* 4 channels */
2811         s->n_chan = 4;
2812         /* length of the channellist */
2813         s->len_chanlist = 4;
2814         /* 12 bit resolution */
2815         s->maxdata = 0x0fff;
2816         /* bipolar range */
2817         s->range_table = (&range_usbdux_ao_range);
2818         /* callback */
2819         s->do_cmdtest = usbdux_ao_cmdtest;
2820         s->do_cmd = usbdux_ao_cmd;
2821         s->cancel = usbdux_ao_cancel;
2822         s->insn_read = usbdux_ao_insn_read;
2823         s->insn_write = usbdux_ao_insn_write;
2824
2825         /* digital I/O */
2826         s = dev->subdevices + SUBDEV_DIO;
2827         s->type = COMEDI_SUBD_DIO;
2828         s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
2829         s->n_chan = 8;
2830         s->maxdata = 1;
2831         s->range_table = (&range_digital);
2832         s->insn_bits = usbdux_dio_insn_bits;
2833         s->insn_config = usbdux_dio_insn_config;
2834         /* we don't use it */
2835         s->private = NULL;
2836
2837         /* counter */
2838         s = dev->subdevices + SUBDEV_COUNTER;
2839         s->type = COMEDI_SUBD_COUNTER;
2840         s->subdev_flags = SDF_WRITABLE | SDF_READABLE;
2841         s->n_chan = 4;
2842         s->maxdata = 0xFFFF;
2843         s->insn_read = usbdux_counter_read;
2844         s->insn_write = usbdux_counter_write;
2845         s->insn_config = usbdux_counter_config;
2846
2847         if (udev->high_speed) {
2848                 /* timer / pwm */
2849                 s = dev->subdevices + SUBDEV_PWM;
2850                 s->type = COMEDI_SUBD_PWM;
2851                 s->subdev_flags = SDF_WRITABLE | SDF_PWM_HBRIDGE;
2852                 s->n_chan = 8;
2853                 /* this defines the max duty cycle resolution */
2854                 s->maxdata = udev->sizePwmBuf;
2855                 s->insn_write = usbdux_pwm_write;
2856                 s->insn_read = usbdux_pwm_read;
2857                 s->insn_config = usbdux_pwm_config;
2858                 usbdux_pwm_period(dev, s, PWM_DEFAULT_PERIOD);
2859         }
2860         /* finally decide that it's attached */
2861         udev->attached = 1;
2862
2863         up(&udev->sem);
2864
2865         up(&start_stop_sem);
2866
2867         dev_info(&udev->interface->dev, "comedi%d: attached to usbdux.\n",
2868                  dev->minor);
2869
2870         return 0;
2871 }
2872
2873 static int usbdux_detach(struct comedi_device *dev)
2874 {
2875         struct usbduxsub *usbduxsub_tmp;
2876
2877         if (!dev) {
2878                 printk(KERN_ERR
2879                         "comedi?: usbdux: detach without dev variable...\n");
2880                 return -EFAULT;
2881         }
2882
2883         usbduxsub_tmp = dev->private;
2884         if (!usbduxsub_tmp) {
2885                 printk(KERN_ERR
2886                         "comedi?: usbdux: detach without ptr to usbduxsub[]\n");
2887                 return -EFAULT;
2888         }
2889
2890         dev_dbg(&usbduxsub_tmp->interface->dev, "comedi%d: detach usb device\n",
2891                 dev->minor);
2892
2893         down(&usbduxsub_tmp->sem);
2894         /* Don't allow detach to free the private structure */
2895         /* It's one entry of of usbduxsub[] */
2896         dev->private = NULL;
2897         usbduxsub_tmp->attached = 0;
2898         usbduxsub_tmp->comedidev = NULL;
2899         dev_dbg(&usbduxsub_tmp->interface->dev,
2900                 "comedi%d: detach: successfully removed\n", dev->minor);
2901         up(&usbduxsub_tmp->sem);
2902         return 0;
2903 }
2904
2905 /* main driver struct */
2906 static struct comedi_driver driver_usbdux = {
2907       .driver_name =    "usbdux",
2908       .module =         THIS_MODULE,
2909       .attach =         usbdux_attach,
2910       .detach =         usbdux_detach,
2911 };
2912
2913 /* Table with the USB-devices: just now only testing IDs */
2914 static struct usb_device_id usbduxsub_table[] = {
2915         {USB_DEVICE(0x13d8, 0x0001) },
2916         {USB_DEVICE(0x13d8, 0x0002) },
2917         {}                      /* Terminating entry */
2918 };
2919
2920 MODULE_DEVICE_TABLE(usb, usbduxsub_table);
2921
2922 /* The usbduxsub-driver */
2923 static struct usb_driver usbduxsub_driver = {
2924       .name =           BOARDNAME,
2925       .probe =          usbduxsub_probe,
2926       .disconnect =     usbduxsub_disconnect,
2927       .id_table =       usbduxsub_table,
2928 };
2929
2930 /* Can't use the nice macro as I have also to initialise the USB */
2931 /* subsystem: */
2932 /* registering the usb-system _and_ the comedi-driver */
2933 static int __init init_usbdux(void)
2934 {
2935         printk(KERN_INFO KBUILD_MODNAME ": "
2936                DRIVER_VERSION ":" DRIVER_DESC "\n");
2937         usb_register(&usbduxsub_driver);
2938         comedi_driver_register(&driver_usbdux);
2939         return 0;
2940 }
2941
2942 /* deregistering the comedi driver and the usb-subsystem */
2943 static void __exit exit_usbdux(void)
2944 {
2945         comedi_driver_unregister(&driver_usbdux);
2946         usb_deregister(&usbduxsub_driver);
2947 }
2948
2949 module_init(init_usbdux);
2950 module_exit(exit_usbdux);
2951
2952 MODULE_AUTHOR(DRIVER_AUTHOR);
2953 MODULE_DESCRIPTION(DRIVER_DESC);
2954 MODULE_LICENSE("GPL");