/* comedi/drivers/usbdux.c Copyright (C) 2003-2007 Bernd Porr, Bernd.Porr@f2s.com This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 2 of the License, or (at your option) any later version. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ /* Driver: usbdux Description: University of Stirling USB DAQ & INCITE Technology Limited Devices: [ITL] USB-DUX (usbdux.o) Author: Bernd Porr Updated: 8 Dec 2008 Status: Stable Configuration options: You have to upload firmware with the -i option. The firmware is usually installed under /usr/share/usb or /usr/local/share/usb or /lib/firmware. Connection scheme for the counter at the digital port: 0=/CLK0, 1=UP/DOWN0, 2=RESET0, 4=/CLK1, 5=UP/DOWN1, 6=RESET1. The sampling rate of the counter is approximately 500Hz. Please note that under USB2.0 the length of the channel list determines the max sampling rate. If you sample only one channel you get 8kHz sampling rate. If you sample two channels you get 4kHz and so on. */ /* * I must give credit here to Chris Baugher who * wrote the driver for AT-MIO-16d. I used some parts of this * driver. I also must give credits to David Brownell * who supported me with the USB development. * * Bernd Porr * * * Revision history: * 0.94: D/A output should work now with any channel list combinations * 0.95: .owner commented out for kernel vers below 2.4.19 * sanity checks in ai/ao_cmd * 0.96: trying to get it working with 2.6, moved all memory alloc to comedi's * attach final USB IDs * moved memory allocation completely to the corresponding comedi * functions firmware upload is by fxload and no longer by comedi (due to * enumeration) * 0.97: USB IDs received, adjusted table * 0.98: SMP, locking, memory alloc: moved all usb memory alloc * to the usb subsystem and moved all comedi related memory * alloc to comedi. * | kernel | registration | usbdux-usb | usbdux-comedi | comedi | * 0.99: USB 2.0: changed protocol to isochronous transfer * IRQ transfer is too buggy and too risky in 2.0 * for the high speed ISO transfer is now a working version * available * 0.99b: Increased the iso transfer buffer for high sp.to 10 buffers. Some VIA * chipsets miss out IRQs. Deeper buffering is needed. * 1.00: full USB 2.0 support for the A/D converter. Now: max 8kHz sampling * rate. * Firmware vers 1.00 is needed for this. * Two 16 bit up/down/reset counter with a sampling rate of 1kHz * And loads of cleaning up, in particular streamlining the * bulk transfers. * 1.1: moved EP4 transfers to EP1 to make space for a PWM output on EP4 * 1.2: added PWM support via EP4 * 2.0: PWM seems to be stable and is not interfering with the other functions * 2.1: changed PWM API * 2.2: added firmware kernel request to fix an udev problem * 2.3: corrected a bug in bulk timeouts which were far too short * 2.4: fixed a bug which causes the driver to hang when it ran out of data. * Thanks to Jan-Matthias Braun and Ian to spot the bug and fix it. * */ /* generates loads of debug info */ /* #define NOISY_DUX_DEBUGBUG */ #include #include #include #include #include #include #include #include #include #include "../comedidev.h" #include "comedi_fc.h" /* timeout for the USB-transfer in ms*/ #define BULK_TIMEOUT 1000 /* constants for "firmware" upload and download */ #define FIRMWARE "usbdux_firmware.bin" #define USBDUXSUB_FIRMWARE 0xA0 #define VENDOR_DIR_IN 0xC0 #define VENDOR_DIR_OUT 0x40 /* internal addresses of the 8051 processor */ #define USBDUXSUB_CPUCS 0xE600 /* * the minor device number, major is 180 only for debugging purposes and to * upload special firmware (programming the eeprom etc) which is not compatible * with the comedi framwork */ #define USBDUXSUB_MINOR 32 /* max lenghth of the transfer-buffer for software upload */ #define TB_LEN 0x2000 /* Input endpoint number: ISO/IRQ */ #define ISOINEP 6 /* Output endpoint number: ISO/IRQ */ #define ISOOUTEP 2 /* This EP sends DUX commands to USBDUX */ #define COMMAND_OUT_EP 1 /* This EP receives the DUX commands from USBDUX */ #define COMMAND_IN_EP 8 /* Output endpoint for PWM */ #define PWM_EP 4 /* 300Hz max frequ under PWM */ #define MIN_PWM_PERIOD ((long)(1E9/300)) /* Default PWM frequency */ #define PWM_DEFAULT_PERIOD ((long)(1E9/100)) /* Number of channels */ #define NUMCHANNELS 8 /* Size of one A/D value */ #define SIZEADIN ((sizeof(int16_t))) /* * Size of the input-buffer IN BYTES * Always multiple of 8 for 8 microframes which is needed in the highspeed mode */ #define SIZEINBUF ((8*SIZEADIN)) /* 16 bytes. */ #define SIZEINSNBUF 16 /* Number of DA channels */ #define NUMOUTCHANNELS 8 /* size of one value for the D/A converter: channel and value */ #define SIZEDAOUT ((sizeof(int8_t)+sizeof(int16_t))) /* * Size of the output-buffer in bytes * Actually only the first 4 triplets are used but for the * high speed mode we need to pad it to 8 (microframes). */ #define SIZEOUTBUF ((8*SIZEDAOUT)) /* * Size of the buffer for the dux commands: just now max size is determined * by the analogue out + command byte + panic bytes... */ #define SIZEOFDUXBUFFER ((8*SIZEDAOUT+2)) /* Number of in-URBs which receive the data: min=2 */ #define NUMOFINBUFFERSFULL 5 /* Number of out-URBs which send the data: min=2 */ #define NUMOFOUTBUFFERSFULL 5 /* Number of in-URBs which receive the data: min=5 */ /* must have more buffers due to buggy USB ctr */ #define NUMOFINBUFFERSHIGH 10 /* Number of out-URBs which send the data: min=5 */ /* must have more buffers due to buggy USB ctr */ #define NUMOFOUTBUFFERSHIGH 10 /* Total number of usbdux devices */ #define NUMUSBDUX 16 /* Analogue in subdevice */ #define SUBDEV_AD 0 /* Analogue out subdevice */ #define SUBDEV_DA 1 /* Digital I/O */ #define SUBDEV_DIO 2 /* counter */ #define SUBDEV_COUNTER 3 /* timer aka pwm output */ #define SUBDEV_PWM 4 /* number of retries to get the right dux command */ #define RETRIES 10 /**************************************************/ /* comedi constants */ static const struct comedi_lrange range_usbdux_ai_range = { 4, { BIP_RANGE (4.096), BIP_RANGE(4.096 / 2), UNI_RANGE (4.096), UNI_RANGE(4.096 / 2) } }; static const struct comedi_lrange range_usbdux_ao_range = { 2, { BIP_RANGE (4.096), UNI_RANGE (4.096), } }; /* * private structure of one subdevice */ /* * This is the structure which holds all the data of * this driver one sub device just now: A/D */ struct usbduxsub { /* attached? */ int attached; /* is it associated with a subdevice? */ int probed; /* pointer to the usb-device */ struct usb_device *usbdev; /* actual number of in-buffers */ int num_in_buffers; /* actual number of out-buffers */ int num_out_buffers; /* ISO-transfer handling: buffers */ struct urb **urb_in; struct urb **urb_out; /* pwm-transfer handling */ struct urb *urb_pwm; /* PWM period */ unsigned int pwm_period; /* PWM internal delay for the GPIF in the FX2 */ int8_t pwn_delay; /* size of the PWM buffer which holds the bit pattern */ int size_pwm_buf; /* input buffer for the ISO-transfer */ int16_t *in_buffer; /* input buffer for single insn */ int16_t *insn_buffer; /* output buffer for single DA outputs */ int16_t *out_buffer; /* interface number */ int ifnum; /* interface structure in 2.6 */ struct usb_interface *interface; /* comedi device for the interrupt context */ struct comedi_device *comedidev; /* is it USB_SPEED_HIGH or not? */ short int high_speed; /* asynchronous command is running */ short int ai_cmd_running; short int ao_cmd_running; /* pwm is running */ short int pwm_cmd_running; /* continous acquisition */ short int ai_continous; short int ao_continous; /* number of samples to acquire */ int ai_sample_count; int ao_sample_count; /* time between samples in units of the timer */ unsigned int ai_timer; unsigned int ao_timer; /* counter between aquisitions */ unsigned int ai_counter; unsigned int ao_counter; /* interval in frames/uframes */ unsigned int ai_interval; /* D/A commands */ int8_t *dac_commands; /* commands */ int8_t *dux_commands; struct semaphore sem; }; /* * The pointer to the private usb-data of the driver is also the private data * for the comedi-device. This has to be global as the usb subsystem needs * global variables. The other reason is that this structure must be there * _before_ any comedi command is issued. The usb subsystem must be initialised * before comedi can access it. */ static struct usbduxsub usbduxsub[NUMUSBDUX]; static DEFINE_SEMAPHORE(start_stop_sem); /* * Stops the data acquision * It should be safe to call this function from any context */ static int usbduxsub_unlink_inurbs(struct usbduxsub *usbduxsub_tmp) { int i = 0; int err = 0; if (usbduxsub_tmp && usbduxsub_tmp->urb_in) { for (i = 0; i < usbduxsub_tmp->num_in_buffers; i++) { if (usbduxsub_tmp->urb_in[i]) { /* We wait here until all transfers have been * cancelled. */ usb_kill_urb(usbduxsub_tmp->urb_in[i]); } dev_dbg(&usbduxsub_tmp->interface->dev, "comedi: usbdux: unlinked InURB %d, err=%d\n", i, err); } } return err; } /* * This will stop a running acquisition operation * Is called from within this driver from both the * interrupt context and from comedi */ static int usbdux_ai_stop(struct usbduxsub *this_usbduxsub, int do_unlink) { int ret = 0; if (!this_usbduxsub) { pr_err("comedi?: usbdux_ai_stop: this_usbduxsub=NULL!\n"); return -EFAULT; } dev_dbg(&this_usbduxsub->interface->dev, "comedi: usbdux_ai_stop\n"); if (do_unlink) { /* stop aquistion */ ret = usbduxsub_unlink_inurbs(this_usbduxsub); } this_usbduxsub->ai_cmd_running = 0; return ret; } /* * This will cancel a running acquisition operation. * This is called by comedi but never from inside the driver. */ static int usbdux_ai_cancel(struct comedi_device *dev, struct comedi_subdevice *s) { struct usbduxsub *this_usbduxsub; int res = 0; /* force unlink of all urbs */ this_usbduxsub = dev->private; if (!this_usbduxsub) return -EFAULT; dev_dbg(&this_usbduxsub->interface->dev, "comedi: usbdux_ai_cancel\n"); /* prevent other CPUs from submitting new commands just now */ down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } /* unlink only if the urb really has been submitted */ res = usbdux_ai_stop(this_usbduxsub, this_usbduxsub->ai_cmd_running); up(&this_usbduxsub->sem); return res; } /* analogue IN - interrupt service routine */ static void usbduxsub_ai_isoc_irq(struct urb *urb) { int i, err, n; struct usbduxsub *this_usbduxsub; struct comedi_device *this_comedidev; struct comedi_subdevice *s; /* the context variable points to the subdevice */ this_comedidev = urb->context; /* the private structure of the subdevice is struct usbduxsub */ this_usbduxsub = this_comedidev->private; /* subdevice which is the AD converter */ s = &this_comedidev->subdevices[SUBDEV_AD]; /* first we test if something unusual has just happened */ switch (urb->status) { case 0: /* copy the result in the transfer buffer */ memcpy(this_usbduxsub->in_buffer, urb->transfer_buffer, SIZEINBUF); break; case -EILSEQ: /* error in the ISOchronous data */ /* we don't copy the data into the transfer buffer */ /* and recycle the last data byte */ dev_dbg(&urb->dev->dev, "comedi%d: usbdux: CRC error in ISO IN stream.\n", this_usbduxsub->comedidev->minor); break; case -ECONNRESET: case -ENOENT: case -ESHUTDOWN: case -ECONNABORTED: /* happens after an unlink command */ if (this_usbduxsub->ai_cmd_running) { /* we are still running a command */ /* tell this comedi */ s->async->events |= COMEDI_CB_EOA; s->async->events |= COMEDI_CB_ERROR; comedi_event(this_usbduxsub->comedidev, s); /* stop the transfer w/o unlink */ usbdux_ai_stop(this_usbduxsub, 0); } return; default: /* a real error on the bus */ /* pass error to comedi if we are really running a command */ if (this_usbduxsub->ai_cmd_running) { dev_err(&urb->dev->dev, "Non-zero urb status received in ai intr " "context: %d\n", urb->status); s->async->events |= COMEDI_CB_EOA; s->async->events |= COMEDI_CB_ERROR; comedi_event(this_usbduxsub->comedidev, s); /* don't do an unlink here */ usbdux_ai_stop(this_usbduxsub, 0); } return; } /* * at this point we are reasonably sure that nothing dodgy has happened * are we running a command? */ if (unlikely((!(this_usbduxsub->ai_cmd_running)))) { /* * not running a command, do not continue execution if no * asynchronous command is running in particular not resubmit */ return; } urb->dev = this_usbduxsub->usbdev; /* resubmit the urb */ err = usb_submit_urb(urb, GFP_ATOMIC); if (unlikely(err < 0)) { dev_err(&urb->dev->dev, "comedi_: urb resubmit failed in int-context! err=%d\n", err); if (err == -EL2NSYNC) dev_err(&urb->dev->dev, "buggy USB host controller or bug in IRQ " "handler!\n"); s->async->events |= COMEDI_CB_EOA; s->async->events |= COMEDI_CB_ERROR; comedi_event(this_usbduxsub->comedidev, s); /* don't do an unlink here */ usbdux_ai_stop(this_usbduxsub, 0); return; } this_usbduxsub->ai_counter--; if (likely(this_usbduxsub->ai_counter > 0)) return; /* timer zero, transfer measurements to comedi */ this_usbduxsub->ai_counter = this_usbduxsub->ai_timer; /* test, if we transmit only a fixed number of samples */ if (!(this_usbduxsub->ai_continous)) { /* not continuous, fixed number of samples */ this_usbduxsub->ai_sample_count--; /* all samples received? */ if (this_usbduxsub->ai_sample_count < 0) { /* prevent a resubmit next time */ usbdux_ai_stop(this_usbduxsub, 0); /* say comedi that the acquistion is over */ s->async->events |= COMEDI_CB_EOA; comedi_event(this_usbduxsub->comedidev, s); return; } } /* get the data from the USB bus and hand it over to comedi */ n = s->async->cmd.chanlist_len; for (i = 0; i < n; i++) { /* transfer data */ if (CR_RANGE(s->async->cmd.chanlist[i]) <= 1) { err = comedi_buf_put (s->async, le16_to_cpu(this_usbduxsub->in_buffer[i]) ^ 0x800); } else { err = comedi_buf_put (s->async, le16_to_cpu(this_usbduxsub->in_buffer[i])); } if (unlikely(err == 0)) { /* buffer overflow */ usbdux_ai_stop(this_usbduxsub, 0); return; } } /* tell comedi that data is there */ s->async->events |= COMEDI_CB_BLOCK | COMEDI_CB_EOS; comedi_event(this_usbduxsub->comedidev, s); } static int usbduxsub_unlink_outurbs(struct usbduxsub *usbduxsub_tmp) { int i = 0; int err = 0; if (usbduxsub_tmp && usbduxsub_tmp->urb_out) { for (i = 0; i < usbduxsub_tmp->num_out_buffers; i++) { if (usbduxsub_tmp->urb_out[i]) usb_kill_urb(usbduxsub_tmp->urb_out[i]); dev_dbg(&usbduxsub_tmp->interface->dev, "comedi: usbdux: unlinked OutURB %d: res=%d\n", i, err); } } return err; } /* This will cancel a running acquisition operation * in any context. */ static int usbdux_ao_stop(struct usbduxsub *this_usbduxsub, int do_unlink) { int ret = 0; if (!this_usbduxsub) return -EFAULT; dev_dbg(&this_usbduxsub->interface->dev, "comedi: usbdux_ao_cancel\n"); if (do_unlink) ret = usbduxsub_unlink_outurbs(this_usbduxsub); this_usbduxsub->ao_cmd_running = 0; return ret; } /* force unlink, is called by comedi */ static int usbdux_ao_cancel(struct comedi_device *dev, struct comedi_subdevice *s) { struct usbduxsub *this_usbduxsub = dev->private; int res = 0; if (!this_usbduxsub) return -EFAULT; /* prevent other CPUs from submitting a command just now */ down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } /* unlink only if it is really running */ res = usbdux_ao_stop(this_usbduxsub, this_usbduxsub->ao_cmd_running); up(&this_usbduxsub->sem); return res; } static void usbduxsub_ao_isoc_irq(struct urb *urb) { int i, ret; int8_t *datap; struct usbduxsub *this_usbduxsub; struct comedi_device *this_comedidev; struct comedi_subdevice *s; /* the context variable points to the subdevice */ this_comedidev = urb->context; /* the private structure of the subdevice is struct usbduxsub */ this_usbduxsub = this_comedidev->private; s = &this_comedidev->subdevices[SUBDEV_DA]; switch (urb->status) { case 0: /* success */ break; case -ECONNRESET: case -ENOENT: case -ESHUTDOWN: case -ECONNABORTED: /* after an unlink command, unplug, ... etc */ /* no unlink needed here. Already shutting down. */ if (this_usbduxsub->ao_cmd_running) { s->async->events |= COMEDI_CB_EOA; comedi_event(this_usbduxsub->comedidev, s); usbdux_ao_stop(this_usbduxsub, 0); } return; default: /* a real error */ if (this_usbduxsub->ao_cmd_running) { dev_err(&urb->dev->dev, "comedi_: Non-zero urb status received in ao " "intr context: %d\n", urb->status); s->async->events |= COMEDI_CB_ERROR; s->async->events |= COMEDI_CB_EOA; comedi_event(this_usbduxsub->comedidev, s); /* we do an unlink if we are in the high speed mode */ usbdux_ao_stop(this_usbduxsub, 0); } return; } /* are we actually running? */ if (!(this_usbduxsub->ao_cmd_running)) return; /* normal operation: executing a command in this subdevice */ this_usbduxsub->ao_counter--; if ((int)this_usbduxsub->ao_counter <= 0) { /* timer zero */ this_usbduxsub->ao_counter = this_usbduxsub->ao_timer; /* handle non continous acquisition */ if (!(this_usbduxsub->ao_continous)) { /* fixed number of samples */ this_usbduxsub->ao_sample_count--; if (this_usbduxsub->ao_sample_count < 0) { /* all samples transmitted */ usbdux_ao_stop(this_usbduxsub, 0); s->async->events |= COMEDI_CB_EOA; comedi_event(this_usbduxsub->comedidev, s); /* no resubmit of the urb */ return; } } /* transmit data to the USB bus */ ((uint8_t *) (urb->transfer_buffer))[0] = s->async->cmd.chanlist_len; for (i = 0; i < s->async->cmd.chanlist_len; i++) { short temp; if (i >= NUMOUTCHANNELS) break; /* pointer to the DA */ datap = (&(((int8_t *) urb->transfer_buffer)[i * 3 + 1])); /* get the data from comedi */ ret = comedi_buf_get(s->async, &temp); datap[0] = temp; datap[1] = temp >> 8; datap[2] = this_usbduxsub->dac_commands[i]; /* printk("data[0]=%x, data[1]=%x, data[2]=%x\n", */ /* datap[0],datap[1],datap[2]); */ if (ret < 0) { dev_err(&urb->dev->dev, "comedi: buffer underflow\n"); s->async->events |= COMEDI_CB_EOA; s->async->events |= COMEDI_CB_OVERFLOW; } /* transmit data to comedi */ s->async->events |= COMEDI_CB_BLOCK; comedi_event(this_usbduxsub->comedidev, s); } } urb->transfer_buffer_length = SIZEOUTBUF; urb->dev = this_usbduxsub->usbdev; urb->status = 0; if (this_usbduxsub->ao_cmd_running) { if (this_usbduxsub->high_speed) { /* uframes */ urb->interval = 8; } else { /* frames */ urb->interval = 1; } urb->number_of_packets = 1; urb->iso_frame_desc[0].offset = 0; urb->iso_frame_desc[0].length = SIZEOUTBUF; urb->iso_frame_desc[0].status = 0; ret = usb_submit_urb(urb, GFP_ATOMIC); if (ret < 0) { dev_err(&urb->dev->dev, "comedi_: ao urb resubm failed in int-cont. " "ret=%d", ret); if (ret == EL2NSYNC) dev_err(&urb->dev->dev, "buggy USB host controller or bug in " "IRQ handling!\n"); s->async->events |= COMEDI_CB_EOA; s->async->events |= COMEDI_CB_ERROR; comedi_event(this_usbduxsub->comedidev, s); /* don't do an unlink here */ usbdux_ao_stop(this_usbduxsub, 0); } } } static int usbduxsub_start(struct usbduxsub *usbduxsub) { int errcode = 0; uint8_t *local_transfer_buffer; local_transfer_buffer = kmalloc(1, GFP_KERNEL); if (!local_transfer_buffer) return -ENOMEM; /* 7f92 to zero */ *local_transfer_buffer = 0; errcode = usb_control_msg(usbduxsub->usbdev, /* create a pipe for a control transfer */ usb_sndctrlpipe(usbduxsub->usbdev, 0), /* bRequest, "Firmware" */ USBDUXSUB_FIRMWARE, /* bmRequestType */ VENDOR_DIR_OUT, /* Value */ USBDUXSUB_CPUCS, /* Index */ 0x0000, /* address of the transfer buffer */ local_transfer_buffer, /* Length */ 1, /* Timeout */ BULK_TIMEOUT); if (errcode < 0) dev_err(&usbduxsub->interface->dev, "comedi_: control msg failed (start)\n"); kfree(local_transfer_buffer); return errcode; } static int usbduxsub_stop(struct usbduxsub *usbduxsub) { int errcode = 0; uint8_t *local_transfer_buffer; local_transfer_buffer = kmalloc(1, GFP_KERNEL); if (!local_transfer_buffer) return -ENOMEM; /* 7f92 to one */ *local_transfer_buffer = 1; errcode = usb_control_msg(usbduxsub->usbdev, usb_sndctrlpipe(usbduxsub->usbdev, 0), /* bRequest, "Firmware" */ USBDUXSUB_FIRMWARE, /* bmRequestType */ VENDOR_DIR_OUT, /* Value */ USBDUXSUB_CPUCS, /* Index */ 0x0000, local_transfer_buffer, /* Length */ 1, /* Timeout */ BULK_TIMEOUT); if (errcode < 0) dev_err(&usbduxsub->interface->dev, "comedi_: control msg failed (stop)\n"); kfree(local_transfer_buffer); return errcode; } static int usbduxsub_upload(struct usbduxsub *usbduxsub, uint8_t *local_transfer_buffer, unsigned int start_addr, unsigned int len) { int errcode; errcode = usb_control_msg(usbduxsub->usbdev, usb_sndctrlpipe(usbduxsub->usbdev, 0), /* brequest, firmware */ USBDUXSUB_FIRMWARE, /* bmRequestType */ VENDOR_DIR_OUT, /* value */ start_addr, /* index */ 0x0000, /* our local safe buffer */ local_transfer_buffer, /* length */ len, /* timeout */ BULK_TIMEOUT); dev_dbg(&usbduxsub->interface->dev, "comedi_: result=%d\n", errcode); if (errcode < 0) { dev_err(&usbduxsub->interface->dev, "comedi_: upload failed\n"); return errcode; } return 0; } #define FIRMWARE_MAX_LEN 0x2000 static int firmware_upload(struct usbduxsub *usbduxsub, const u8 *firmware_binary, int size_firmware) { int ret; uint8_t *fw_buf; if (!firmware_binary) return 0; if (size_firmware > FIRMWARE_MAX_LEN) { dev_err(&usbduxsub->interface->dev, "usbdux firmware binary it too large for FX2.\n"); return -ENOMEM; } /* we generate a local buffer for the firmware */ fw_buf = kmemdup(firmware_binary, size_firmware, GFP_KERNEL); if (!fw_buf) { dev_err(&usbduxsub->interface->dev, "comedi_: mem alloc for firmware failed\n"); return -ENOMEM; } ret = usbduxsub_stop(usbduxsub); if (ret < 0) { dev_err(&usbduxsub->interface->dev, "comedi_: can not stop firmware\n"); kfree(fw_buf); return ret; } ret = usbduxsub_upload(usbduxsub, fw_buf, 0, size_firmware); if (ret < 0) { dev_err(&usbduxsub->interface->dev, "comedi_: firmware upload failed\n"); kfree(fw_buf); return ret; } ret = usbduxsub_start(usbduxsub); if (ret < 0) { dev_err(&usbduxsub->interface->dev, "comedi_: can not start firmware\n"); kfree(fw_buf); return ret; } kfree(fw_buf); return 0; } static int usbduxsub_submit_inurbs(struct usbduxsub *usbduxsub) { int i, err_flag; if (!usbduxsub) return -EFAULT; /* Submit all URBs and start the transfer on the bus */ for (i = 0; i < usbduxsub->num_in_buffers; i++) { /* in case of a resubmission after an unlink... */ usbduxsub->urb_in[i]->interval = usbduxsub->ai_interval; usbduxsub->urb_in[i]->context = usbduxsub->comedidev; usbduxsub->urb_in[i]->dev = usbduxsub->usbdev; usbduxsub->urb_in[i]->status = 0; usbduxsub->urb_in[i]->transfer_flags = URB_ISO_ASAP; dev_dbg(&usbduxsub->interface->dev, "comedi%d: submitting in-urb[%d]: %p,%p intv=%d\n", usbduxsub->comedidev->minor, i, (usbduxsub->urb_in[i]->context), (usbduxsub->urb_in[i]->dev), (usbduxsub->urb_in[i]->interval)); err_flag = usb_submit_urb(usbduxsub->urb_in[i], GFP_ATOMIC); if (err_flag) { dev_err(&usbduxsub->interface->dev, "comedi_: ai: usb_submit_urb(%d) error %d\n", i, err_flag); return err_flag; } } return 0; } static int usbduxsub_submit_outurbs(struct usbduxsub *usbduxsub) { int i, err_flag; if (!usbduxsub) return -EFAULT; for (i = 0; i < usbduxsub->num_out_buffers; i++) { dev_dbg(&usbduxsub->interface->dev, "comedi_: submitting out-urb[%d]\n", i); /* in case of a resubmission after an unlink... */ usbduxsub->urb_out[i]->context = usbduxsub->comedidev; usbduxsub->urb_out[i]->dev = usbduxsub->usbdev; usbduxsub->urb_out[i]->status = 0; usbduxsub->urb_out[i]->transfer_flags = URB_ISO_ASAP; err_flag = usb_submit_urb(usbduxsub->urb_out[i], GFP_ATOMIC); if (err_flag) { dev_err(&usbduxsub->interface->dev, "comedi_: ao: usb_submit_urb(%d) error %d\n", i, err_flag); return err_flag; } } return 0; } static int usbdux_ai_cmdtest(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_cmd *cmd) { struct usbduxsub *this_usbduxsub = dev->private; int err = 0, i; unsigned int tmp_timer; if (!(this_usbduxsub->probed)) return -ENODEV; /* Step 1 : check if triggers are trivially valid */ err |= cfc_check_trigger_src(&cmd->start_src, TRIG_NOW | TRIG_INT); err |= cfc_check_trigger_src(&cmd->scan_begin_src, TRIG_TIMER); err |= cfc_check_trigger_src(&cmd->convert_src, TRIG_NOW); err |= cfc_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT); err |= cfc_check_trigger_src(&cmd->stop_src, TRIG_COUNT | TRIG_NONE); if (err) return 1; /* Step 2a : make sure trigger sources are unique */ err |= cfc_check_trigger_is_unique(cmd->start_src); err |= cfc_check_trigger_is_unique(cmd->stop_src); /* Step 2b : and mutually compatible */ if (err) return 2; /* Step 3: check if arguments are trivially valid */ err |= cfc_check_trigger_arg_is(&cmd->start_arg, 0); if (cmd->scan_begin_src == TRIG_FOLLOW) /* internal trigger */ err |= cfc_check_trigger_arg_is(&cmd->scan_begin_arg, 0); if (cmd->scan_begin_src == TRIG_TIMER) { if (this_usbduxsub->high_speed) { /* * In high speed mode microframes are possible. * However, during one microframe we can roughly * sample one channel. Thus, the more channels * are in the channel list the more time we need. */ i = 1; /* find a power of 2 for the number of channels */ while (i < (cmd->chanlist_len)) i = i * 2; err |= cfc_check_trigger_arg_min(&cmd->scan_begin_arg, 1000000 / 8 * i); /* now calc the real sampling rate with all the * rounding errors */ tmp_timer = ((unsigned int)(cmd->scan_begin_arg / 125000)) * 125000; } else { /* full speed */ /* 1kHz scans every USB frame */ err |= cfc_check_trigger_arg_min(&cmd->scan_begin_arg, 1000000); /* * calc the real sampling rate with the rounding errors */ tmp_timer = ((unsigned int)(cmd->scan_begin_arg / 1000000)) * 1000000; } err |= cfc_check_trigger_arg_is(&cmd->scan_begin_arg, tmp_timer); } err |= cfc_check_trigger_arg_is(&cmd->scan_end_arg, cmd->chanlist_len); if (cmd->stop_src == TRIG_COUNT) { /* any count is allowed */ } else { /* TRIG_NONE */ err |= cfc_check_trigger_arg_is(&cmd->stop_arg, 0); } if (err) return 3; return 0; } /* * creates the ADC command for the MAX1271 * range is the range value from comedi */ static int8_t create_adc_command(unsigned int chan, int range) { int8_t p = (range <= 1); int8_t r = ((range % 2) == 0); return (chan << 4) | ((p == 1) << 2) | ((r == 1) << 3); } /* bulk transfers to usbdux */ #define SENDADCOMMANDS 0 #define SENDDACOMMANDS 1 #define SENDDIOCONFIGCOMMAND 2 #define SENDDIOBITSCOMMAND 3 #define SENDSINGLEAD 4 #define READCOUNTERCOMMAND 5 #define WRITECOUNTERCOMMAND 6 #define SENDPWMON 7 #define SENDPWMOFF 8 static int send_dux_commands(struct usbduxsub *this_usbduxsub, int cmd_type) { int result, nsent; this_usbduxsub->dux_commands[0] = cmd_type; #ifdef NOISY_DUX_DEBUGBUG printk(KERN_DEBUG "comedi%d: usbdux: dux_commands: ", this_usbduxsub->comedidev->minor); for (result = 0; result < SIZEOFDUXBUFFER; result++) printk(" %02x", this_usbduxsub->dux_commands[result]); printk("\n"); #endif result = usb_bulk_msg(this_usbduxsub->usbdev, usb_sndbulkpipe(this_usbduxsub->usbdev, COMMAND_OUT_EP), this_usbduxsub->dux_commands, SIZEOFDUXBUFFER, &nsent, BULK_TIMEOUT); if (result < 0) dev_err(&this_usbduxsub->interface->dev, "comedi%d: " "could not transmit dux_command to the usb-device, " "err=%d\n", this_usbduxsub->comedidev->minor, result); return result; } static int receive_dux_commands(struct usbduxsub *this_usbduxsub, int command) { int result = (-EFAULT); int nrec; int i; for (i = 0; i < RETRIES; i++) { result = usb_bulk_msg(this_usbduxsub->usbdev, usb_rcvbulkpipe(this_usbduxsub->usbdev, COMMAND_IN_EP), this_usbduxsub->insn_buffer, SIZEINSNBUF, &nrec, BULK_TIMEOUT); if (result < 0) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: " "insn: USB error %d while receiving DUX command" "\n", this_usbduxsub->comedidev->minor, result); return result; } if (le16_to_cpu(this_usbduxsub->insn_buffer[0]) == command) return result; } /* this is only reached if the data has been requested a couple of * times */ dev_err(&this_usbduxsub->interface->dev, "comedi%d: insn: " "wrong data returned from firmware: want cmd %d, got cmd %d.\n", this_usbduxsub->comedidev->minor, command, le16_to_cpu(this_usbduxsub->insn_buffer[0])); return -EFAULT; } static int usbdux_ai_inttrig(struct comedi_device *dev, struct comedi_subdevice *s, unsigned int trignum) { int ret; struct usbduxsub *this_usbduxsub = dev->private; if (!this_usbduxsub) return -EFAULT; down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: usbdux_ai_inttrig\n", dev->minor); if (trignum != 0) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: usbdux_ai_inttrig: invalid trignum\n", dev->minor); up(&this_usbduxsub->sem); return -EINVAL; } if (!(this_usbduxsub->ai_cmd_running)) { this_usbduxsub->ai_cmd_running = 1; ret = usbduxsub_submit_inurbs(this_usbduxsub); if (ret < 0) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: usbdux_ai_inttrig: " "urbSubmit: err=%d\n", dev->minor, ret); this_usbduxsub->ai_cmd_running = 0; up(&this_usbduxsub->sem); return ret; } s->async->inttrig = NULL; } else { dev_err(&this_usbduxsub->interface->dev, "comedi%d: ai_inttrig but acqu is already running\n", dev->minor); } up(&this_usbduxsub->sem); return 1; } static int usbdux_ai_cmd(struct comedi_device *dev, struct comedi_subdevice *s) { struct comedi_cmd *cmd = &s->async->cmd; unsigned int chan, range; int i, ret; struct usbduxsub *this_usbduxsub = dev->private; int result; if (!this_usbduxsub) return -EFAULT; dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: usbdux_ai_cmd\n", dev->minor); /* block other CPUs from starting an ai_cmd */ down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } if (this_usbduxsub->ai_cmd_running) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: " "ai_cmd not possible. Another ai_cmd is running.\n", dev->minor); up(&this_usbduxsub->sem); return -EBUSY; } /* set current channel of the running acquisition to zero */ s->async->cur_chan = 0; this_usbduxsub->dux_commands[1] = cmd->chanlist_len; for (i = 0; i < cmd->chanlist_len; ++i) { chan = CR_CHAN(cmd->chanlist[i]); range = CR_RANGE(cmd->chanlist[i]); if (i >= NUMCHANNELS) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: channel list too long\n", dev->minor); break; } this_usbduxsub->dux_commands[i + 2] = create_adc_command(chan, range); } dev_dbg(&this_usbduxsub->interface->dev, "comedi %d: sending commands to the usb device: size=%u\n", dev->minor, NUMCHANNELS); result = send_dux_commands(this_usbduxsub, SENDADCOMMANDS); if (result < 0) { up(&this_usbduxsub->sem); return result; } if (this_usbduxsub->high_speed) { /* * every channel gets a time window of 125us. Thus, if we * sample all 8 channels we need 1ms. If we sample only one * channel we need only 125us */ this_usbduxsub->ai_interval = 1; /* find a power of 2 for the interval */ while ((this_usbduxsub->ai_interval) < (cmd->chanlist_len)) { this_usbduxsub->ai_interval = (this_usbduxsub->ai_interval) * 2; } this_usbduxsub->ai_timer = cmd->scan_begin_arg / (125000 * (this_usbduxsub-> ai_interval)); } else { /* interval always 1ms */ this_usbduxsub->ai_interval = 1; this_usbduxsub->ai_timer = cmd->scan_begin_arg / 1000000; } if (this_usbduxsub->ai_timer < 1) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: ai_cmd: " "timer=%d, scan_begin_arg=%d. " "Not properly tested by cmdtest?\n", dev->minor, this_usbduxsub->ai_timer, cmd->scan_begin_arg); up(&this_usbduxsub->sem); return -EINVAL; } this_usbduxsub->ai_counter = this_usbduxsub->ai_timer; if (cmd->stop_src == TRIG_COUNT) { /* data arrives as one packet */ this_usbduxsub->ai_sample_count = cmd->stop_arg; this_usbduxsub->ai_continous = 0; } else { /* continous acquisition */ this_usbduxsub->ai_continous = 1; this_usbduxsub->ai_sample_count = 0; } if (cmd->start_src == TRIG_NOW) { /* enable this acquisition operation */ this_usbduxsub->ai_cmd_running = 1; ret = usbduxsub_submit_inurbs(this_usbduxsub); if (ret < 0) { this_usbduxsub->ai_cmd_running = 0; /* fixme: unlink here?? */ up(&this_usbduxsub->sem); return ret; } s->async->inttrig = NULL; } else { /* TRIG_INT */ /* don't enable the acquision operation */ /* wait for an internal signal */ s->async->inttrig = usbdux_ai_inttrig; } up(&this_usbduxsub->sem); return 0; } /* Mode 0 is used to get a single conversion on demand */ static int usbdux_ai_insn_read(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { int i; unsigned int one = 0; int chan, range; int err; struct usbduxsub *this_usbduxsub = dev->private; if (!this_usbduxsub) return 0; dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: ai_insn_read, insn->n=%d, insn->subdev=%d\n", dev->minor, insn->n, insn->subdev); down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } if (this_usbduxsub->ai_cmd_running) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: ai_insn_read not possible. " "Async Command is running.\n", dev->minor); up(&this_usbduxsub->sem); return 0; } /* sample one channel */ chan = CR_CHAN(insn->chanspec); range = CR_RANGE(insn->chanspec); /* set command for the first channel */ this_usbduxsub->dux_commands[1] = create_adc_command(chan, range); /* adc commands */ err = send_dux_commands(this_usbduxsub, SENDSINGLEAD); if (err < 0) { up(&this_usbduxsub->sem); return err; } for (i = 0; i < insn->n; i++) { err = receive_dux_commands(this_usbduxsub, SENDSINGLEAD); if (err < 0) { up(&this_usbduxsub->sem); return 0; } one = le16_to_cpu(this_usbduxsub->insn_buffer[1]); if (CR_RANGE(insn->chanspec) <= 1) one = one ^ 0x800; data[i] = one; } up(&this_usbduxsub->sem); return i; } /************************************/ /* analog out */ static int usbdux_ao_insn_read(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { int i; int chan = CR_CHAN(insn->chanspec); struct usbduxsub *this_usbduxsub = dev->private; if (!this_usbduxsub) return -EFAULT; down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } for (i = 0; i < insn->n; i++) data[i] = this_usbduxsub->out_buffer[chan]; up(&this_usbduxsub->sem); return i; } static int usbdux_ao_insn_write(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { int i, err; int chan = CR_CHAN(insn->chanspec); struct usbduxsub *this_usbduxsub = dev->private; if (!this_usbduxsub) return -EFAULT; dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: ao_insn_write\n", dev->minor); down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } if (this_usbduxsub->ao_cmd_running) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: ao_insn_write: " "ERROR: asynchronous ao_cmd is running\n", dev->minor); up(&this_usbduxsub->sem); return 0; } for (i = 0; i < insn->n; i++) { dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: ao_insn_write: data[chan=%d,i=%d]=%d\n", dev->minor, chan, i, data[i]); /* number of channels: 1 */ this_usbduxsub->dux_commands[1] = 1; /* one 16 bit value */ *((int16_t *) (this_usbduxsub->dux_commands + 2)) = cpu_to_le16(data[i]); this_usbduxsub->out_buffer[chan] = data[i]; /* channel number */ this_usbduxsub->dux_commands[4] = (chan << 6); err = send_dux_commands(this_usbduxsub, SENDDACOMMANDS); if (err < 0) { up(&this_usbduxsub->sem); return err; } } up(&this_usbduxsub->sem); return i; } static int usbdux_ao_inttrig(struct comedi_device *dev, struct comedi_subdevice *s, unsigned int trignum) { int ret; struct usbduxsub *this_usbduxsub = dev->private; if (!this_usbduxsub) return -EFAULT; down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } if (trignum != 0) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: usbdux_ao_inttrig: invalid trignum\n", dev->minor); up(&this_usbduxsub->sem); return -EINVAL; } if (!(this_usbduxsub->ao_cmd_running)) { this_usbduxsub->ao_cmd_running = 1; ret = usbduxsub_submit_outurbs(this_usbduxsub); if (ret < 0) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: usbdux_ao_inttrig: submitURB: " "err=%d\n", dev->minor, ret); this_usbduxsub->ao_cmd_running = 0; up(&this_usbduxsub->sem); return ret; } s->async->inttrig = NULL; } else { dev_err(&this_usbduxsub->interface->dev, "comedi%d: ao_inttrig but acqu is already running.\n", dev->minor); } up(&this_usbduxsub->sem); return 1; } static int usbdux_ao_cmdtest(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_cmd *cmd) { struct usbduxsub *this_usbduxsub = dev->private; int err = 0; unsigned int flags; if (!this_usbduxsub) return -EFAULT; if (!(this_usbduxsub->probed)) return -ENODEV; /* Step 1 : check if triggers are trivially valid */ err |= cfc_check_trigger_src(&cmd->start_src, TRIG_NOW | TRIG_INT); if (0) { /* (this_usbduxsub->high_speed) */ /* the sampling rate is set by the coversion rate */ flags = TRIG_FOLLOW; } else { /* start a new scan (output at once) with a timer */ flags = TRIG_TIMER; } err |= cfc_check_trigger_src(&cmd->scan_begin_src, flags); if (0) { /* (this_usbduxsub->high_speed) */ /* * in usb-2.0 only one conversion it transmitted * but with 8kHz/n */ flags = TRIG_TIMER; } else { /* * all conversion events happen simultaneously with * a rate of 1kHz/n */ flags = TRIG_NOW; } err |= cfc_check_trigger_src(&cmd->convert_src, flags); err |= cfc_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT); err |= cfc_check_trigger_src(&cmd->stop_src, TRIG_COUNT | TRIG_NONE); if (err) return 1; /* Step 2a : make sure trigger sources are unique */ err |= cfc_check_trigger_is_unique(cmd->start_src); err |= cfc_check_trigger_is_unique(cmd->stop_src); /* Step 2b : and mutually compatible */ if (err) return 2; /* Step 3: check if arguments are trivially valid */ err |= cfc_check_trigger_arg_is(&cmd->start_arg, 0); if (cmd->scan_begin_src == TRIG_FOLLOW) /* internal trigger */ err |= cfc_check_trigger_arg_is(&cmd->scan_begin_arg, 0); if (cmd->scan_begin_src == TRIG_TIMER) err |= cfc_check_trigger_arg_min(&cmd->scan_begin_arg, 1000000); /* not used now, is for later use */ if (cmd->convert_src == TRIG_TIMER) err |= cfc_check_trigger_arg_min(&cmd->convert_arg, 125000); err |= cfc_check_trigger_arg_is(&cmd->scan_end_arg, cmd->chanlist_len); if (cmd->stop_src == TRIG_COUNT) { /* any count is allowed */ } else { /* TRIG_NONE */ err |= cfc_check_trigger_arg_is(&cmd->stop_arg, 0); } if (err) return 3; return 0; } static int usbdux_ao_cmd(struct comedi_device *dev, struct comedi_subdevice *s) { struct comedi_cmd *cmd = &s->async->cmd; unsigned int chan, gain; int i, ret; struct usbduxsub *this_usbduxsub = dev->private; if (!this_usbduxsub) return -EFAULT; down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: %s\n", dev->minor, __func__); /* set current channel of the running acquisition to zero */ s->async->cur_chan = 0; for (i = 0; i < cmd->chanlist_len; ++i) { chan = CR_CHAN(cmd->chanlist[i]); gain = CR_RANGE(cmd->chanlist[i]); if (i >= NUMOUTCHANNELS) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: %s: channel list too long\n", dev->minor, __func__); break; } this_usbduxsub->dac_commands[i] = (chan << 6); dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: dac command for ch %d is %x\n", dev->minor, i, this_usbduxsub->dac_commands[i]); } /* we count in steps of 1ms (125us) */ /* 125us mode not used yet */ if (0) { /* (this_usbduxsub->high_speed) */ /* 125us */ /* timing of the conversion itself: every 125 us */ this_usbduxsub->ao_timer = cmd->convert_arg / 125000; } else { /* 1ms */ /* timing of the scan: we get all channels at once */ this_usbduxsub->ao_timer = cmd->scan_begin_arg / 1000000; dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: scan_begin_src=%d, scan_begin_arg=%d, " "convert_src=%d, convert_arg=%d\n", dev->minor, cmd->scan_begin_src, cmd->scan_begin_arg, cmd->convert_src, cmd->convert_arg); dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: ao_timer=%d (ms)\n", dev->minor, this_usbduxsub->ao_timer); if (this_usbduxsub->ao_timer < 1) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: usbdux: ao_timer=%d, " "scan_begin_arg=%d. " "Not properly tested by cmdtest?\n", dev->minor, this_usbduxsub->ao_timer, cmd->scan_begin_arg); up(&this_usbduxsub->sem); return -EINVAL; } } this_usbduxsub->ao_counter = this_usbduxsub->ao_timer; if (cmd->stop_src == TRIG_COUNT) { /* not continuous */ /* counter */ /* high speed also scans everything at once */ if (0) { /* (this_usbduxsub->high_speed) */ this_usbduxsub->ao_sample_count = (cmd->stop_arg) * (cmd->scan_end_arg); } else { /* there's no scan as the scan has been */ /* perf inside the FX2 */ /* data arrives as one packet */ this_usbduxsub->ao_sample_count = cmd->stop_arg; } this_usbduxsub->ao_continous = 0; } else { /* continous acquisition */ this_usbduxsub->ao_continous = 1; this_usbduxsub->ao_sample_count = 0; } if (cmd->start_src == TRIG_NOW) { /* enable this acquisition operation */ this_usbduxsub->ao_cmd_running = 1; ret = usbduxsub_submit_outurbs(this_usbduxsub); if (ret < 0) { this_usbduxsub->ao_cmd_running = 0; /* fixme: unlink here?? */ up(&this_usbduxsub->sem); return ret; } s->async->inttrig = NULL; } else { /* TRIG_INT */ /* submit the urbs later */ /* wait for an internal signal */ s->async->inttrig = usbdux_ao_inttrig; } up(&this_usbduxsub->sem); return 0; } static int usbdux_dio_insn_config(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { int chan = CR_CHAN(insn->chanspec); /* The input or output configuration of each digital line is * configured by a special insn_config instruction. chanspec * contains the channel to be changed, and data[0] contains the * value COMEDI_INPUT or COMEDI_OUTPUT. */ switch (data[0]) { case INSN_CONFIG_DIO_OUTPUT: s->io_bits |= 1 << chan; /* 1 means Out */ break; case INSN_CONFIG_DIO_INPUT: s->io_bits &= ~(1 << chan); break; case INSN_CONFIG_DIO_QUERY: data[1] = (s->io_bits & (1 << chan)) ? COMEDI_OUTPUT : COMEDI_INPUT; break; default: return -EINVAL; break; } /* we don't tell the firmware here as it would take 8 frames */ /* to submit the information. We do it in the insn_bits. */ return insn->n; } static int usbdux_dio_insn_bits(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { struct usbduxsub *this_usbduxsub = dev->private; int err; if (!this_usbduxsub) return -EFAULT; down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } /* The insn data is a mask in data[0] and the new data * in data[1], each channel cooresponding to a bit. */ s->state &= ~data[0]; s->state |= data[0] & data[1]; this_usbduxsub->dux_commands[1] = s->io_bits; this_usbduxsub->dux_commands[2] = s->state; /* This command also tells the firmware to return */ /* the digital input lines */ err = send_dux_commands(this_usbduxsub, SENDDIOBITSCOMMAND); if (err < 0) { up(&this_usbduxsub->sem); return err; } err = receive_dux_commands(this_usbduxsub, SENDDIOBITSCOMMAND); if (err < 0) { up(&this_usbduxsub->sem); return err; } data[1] = le16_to_cpu(this_usbduxsub->insn_buffer[1]); up(&this_usbduxsub->sem); return insn->n; } /* reads the 4 counters, only two are used just now */ static int usbdux_counter_read(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { struct usbduxsub *this_usbduxsub = dev->private; int chan = insn->chanspec; int err; if (!this_usbduxsub) return -EFAULT; down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } err = send_dux_commands(this_usbduxsub, READCOUNTERCOMMAND); if (err < 0) { up(&this_usbduxsub->sem); return err; } err = receive_dux_commands(this_usbduxsub, READCOUNTERCOMMAND); if (err < 0) { up(&this_usbduxsub->sem); return err; } data[0] = le16_to_cpu(this_usbduxsub->insn_buffer[chan + 1]); up(&this_usbduxsub->sem); return 1; } static int usbdux_counter_write(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { struct usbduxsub *this_usbduxsub = dev->private; int err; if (!this_usbduxsub) return -EFAULT; down(&this_usbduxsub->sem); if (!(this_usbduxsub->probed)) { up(&this_usbduxsub->sem); return -ENODEV; } this_usbduxsub->dux_commands[1] = insn->chanspec; *((int16_t *) (this_usbduxsub->dux_commands + 2)) = cpu_to_le16(*data); err = send_dux_commands(this_usbduxsub, WRITECOUNTERCOMMAND); if (err < 0) { up(&this_usbduxsub->sem); return err; } up(&this_usbduxsub->sem); return 1; } static int usbdux_counter_config(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { /* nothing to do so far */ return 2; } /***********************************/ /* PWM */ static int usbduxsub_unlink_pwm_urbs(struct usbduxsub *usbduxsub_tmp) { int err = 0; if (usbduxsub_tmp && usbduxsub_tmp->urb_pwm) { if (usbduxsub_tmp->urb_pwm) usb_kill_urb(usbduxsub_tmp->urb_pwm); dev_dbg(&usbduxsub_tmp->interface->dev, "comedi: unlinked PwmURB: res=%d\n", err); } return err; } /* This cancels a running acquisition operation * in any context. */ static int usbdux_pwm_stop(struct usbduxsub *this_usbduxsub, int do_unlink) { int ret = 0; if (!this_usbduxsub) return -EFAULT; dev_dbg(&this_usbduxsub->interface->dev, "comedi: %s\n", __func__); if (do_unlink) ret = usbduxsub_unlink_pwm_urbs(this_usbduxsub); this_usbduxsub->pwm_cmd_running = 0; return ret; } /* force unlink - is called by comedi */ static int usbdux_pwm_cancel(struct comedi_device *dev, struct comedi_subdevice *s) { struct usbduxsub *this_usbduxsub = dev->private; int res = 0; /* unlink only if it is really running */ res = usbdux_pwm_stop(this_usbduxsub, this_usbduxsub->pwm_cmd_running); dev_dbg(&this_usbduxsub->interface->dev, "comedi %d: sending pwm off command to the usb device.\n", dev->minor); return send_dux_commands(this_usbduxsub, SENDPWMOFF); } static void usbduxsub_pwm_irq(struct urb *urb) { int ret; struct usbduxsub *this_usbduxsub; struct comedi_device *this_comedidev; struct comedi_subdevice *s; /* printk(KERN_DEBUG "PWM: IRQ\n"); */ /* the context variable points to the subdevice */ this_comedidev = urb->context; /* the private structure of the subdevice is struct usbduxsub */ this_usbduxsub = this_comedidev->private; s = &this_comedidev->subdevices[SUBDEV_DA]; switch (urb->status) { case 0: /* success */ break; case -ECONNRESET: case -ENOENT: case -ESHUTDOWN: case -ECONNABORTED: /* * after an unlink command, unplug, ... etc * no unlink needed here. Already shutting down. */ if (this_usbduxsub->pwm_cmd_running) usbdux_pwm_stop(this_usbduxsub, 0); return; default: /* a real error */ if (this_usbduxsub->pwm_cmd_running) { dev_err(&this_usbduxsub->interface->dev, "comedi_: Non-zero urb status received in " "pwm intr context: %d\n", urb->status); usbdux_pwm_stop(this_usbduxsub, 0); } return; } /* are we actually running? */ if (!(this_usbduxsub->pwm_cmd_running)) return; urb->transfer_buffer_length = this_usbduxsub->size_pwm_buf; urb->dev = this_usbduxsub->usbdev; urb->status = 0; if (this_usbduxsub->pwm_cmd_running) { ret = usb_submit_urb(urb, GFP_ATOMIC); if (ret < 0) { dev_err(&this_usbduxsub->interface->dev, "comedi_: pwm urb resubm failed in int-cont. " "ret=%d", ret); if (ret == EL2NSYNC) dev_err(&this_usbduxsub->interface->dev, "buggy USB host controller or bug in " "IRQ handling!\n"); /* don't do an unlink here */ usbdux_pwm_stop(this_usbduxsub, 0); } } } static int usbduxsub_submit_pwm_urbs(struct usbduxsub *usbduxsub) { int err_flag; if (!usbduxsub) return -EFAULT; dev_dbg(&usbduxsub->interface->dev, "comedi_: submitting pwm-urb\n"); /* in case of a resubmission after an unlink... */ usb_fill_bulk_urb(usbduxsub->urb_pwm, usbduxsub->usbdev, usb_sndbulkpipe(usbduxsub->usbdev, PWM_EP), usbduxsub->urb_pwm->transfer_buffer, usbduxsub->size_pwm_buf, usbduxsub_pwm_irq, usbduxsub->comedidev); err_flag = usb_submit_urb(usbduxsub->urb_pwm, GFP_ATOMIC); if (err_flag) { dev_err(&usbduxsub->interface->dev, "comedi_: usbdux: pwm: usb_submit_urb error %d\n", err_flag); return err_flag; } return 0; } static int usbdux_pwm_period(struct comedi_device *dev, struct comedi_subdevice *s, unsigned int period) { struct usbduxsub *this_usbduxsub = dev->private; int fx2delay = 255; if (period < MIN_PWM_PERIOD) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: illegal period setting for pwm.\n", dev->minor); return -EAGAIN; } else { fx2delay = period / ((int)(6 * 512 * (1.0 / 0.033))) - 6; if (fx2delay > 255) { dev_err(&this_usbduxsub->interface->dev, "comedi%d: period %d for pwm is too low.\n", dev->minor, period); return -EAGAIN; } } this_usbduxsub->pwn_delay = fx2delay; this_usbduxsub->pwm_period = period; dev_dbg(&this_usbduxsub->interface->dev, "%s: frequ=%d, period=%d\n", __func__, period, fx2delay); return 0; } /* is called from insn so there's no need to do all the sanity checks */ static int usbdux_pwm_start(struct comedi_device *dev, struct comedi_subdevice *s) { int ret, i; struct usbduxsub *this_usbduxsub = dev->private; dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: %s\n", dev->minor, __func__); if (this_usbduxsub->pwm_cmd_running) { /* already running */ return 0; } this_usbduxsub->dux_commands[1] = ((int8_t) this_usbduxsub->pwn_delay); ret = send_dux_commands(this_usbduxsub, SENDPWMON); if (ret < 0) return ret; /* initialise the buffer */ for (i = 0; i < this_usbduxsub->size_pwm_buf; i++) ((char *)(this_usbduxsub->urb_pwm->transfer_buffer))[i] = 0; this_usbduxsub->pwm_cmd_running = 1; ret = usbduxsub_submit_pwm_urbs(this_usbduxsub); if (ret < 0) { this_usbduxsub->pwm_cmd_running = 0; return ret; } return 0; } /* generates the bit pattern for PWM with the optional sign bit */ static int usbdux_pwm_pattern(struct comedi_device *dev, struct comedi_subdevice *s, int channel, unsigned int value, unsigned int sign) { struct usbduxsub *this_usbduxsub = dev->private; int i, szbuf; char *p_buf; char pwm_mask; char sgn_mask; char c; if (!this_usbduxsub) return -EFAULT; /* this is the DIO bit which carries the PWM data */ pwm_mask = (1 << channel); /* this is the DIO bit which carries the optional direction bit */ sgn_mask = (16 << channel); /* this is the buffer which will be filled with the with bit */ /* pattern for one period */ szbuf = this_usbduxsub->size_pwm_buf; p_buf = (char *)(this_usbduxsub->urb_pwm->transfer_buffer); for (i = 0; i < szbuf; i++) { c = *p_buf; /* reset bits */ c = c & (~pwm_mask); /* set the bit as long as the index is lower than the value */ if (i < value) c = c | pwm_mask; /* set the optional sign bit for a relay */ if (!sign) { /* positive value */ c = c & (~sgn_mask); } else { /* negative value */ c = c | sgn_mask; } *(p_buf++) = c; } return 1; } static int usbdux_pwm_write(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { struct usbduxsub *this_usbduxsub = dev->private; if (!this_usbduxsub) return -EFAULT; if ((insn->n) != 1) { /* * doesn't make sense to have more than one value here because * it would just overwrite the PWM buffer a couple of times */ return -EINVAL; } /* * the sign is set via a special INSN only, this gives us 8 bits for * normal operation * relay sign 0 by default */ return usbdux_pwm_pattern(dev, s, CR_CHAN(insn->chanspec), data[0], 0); } static int usbdux_pwm_read(struct comedi_device *x1, struct comedi_subdevice *x2, struct comedi_insn *x3, unsigned int *x4) { /* not needed */ return -EINVAL; }; /* switches on/off PWM */ static int usbdux_pwm_config(struct comedi_device *dev, struct comedi_subdevice *s, struct comedi_insn *insn, unsigned int *data) { struct usbduxsub *this_usbduxsub = dev->private; switch (data[0]) { case INSN_CONFIG_ARM: /* switch it on */ dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: %s: pwm on\n", dev->minor, __func__); /* * if not zero the PWM is limited to a certain time which is * not supported here */ if (data[1] != 0) return -EINVAL; return usbdux_pwm_start(dev, s); case INSN_CONFIG_DISARM: dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: %s: pwm off\n", dev->minor, __func__); return usbdux_pwm_cancel(dev, s); case INSN_CONFIG_GET_PWM_STATUS: /* * to check if the USB transmission has failed or in case PWM * was limited to n cycles to check if it has terminated */ data[1] = this_usbduxsub->pwm_cmd_running; return 0; case INSN_CONFIG_PWM_SET_PERIOD: dev_dbg(&this_usbduxsub->interface->dev, "comedi%d: %s: setting period\n", dev->minor, __func__); return usbdux_pwm_period(dev, s, data[1]); case INSN_CONFIG_PWM_GET_PERIOD: data[1] = this_usbduxsub->pwm_period; return 0; case INSN_CONFIG_PWM_SET_H_BRIDGE: /* value in the first byte and the sign in the second for a relay */ return usbdux_pwm_pattern(dev, s, /* the channel number */ CR_CHAN(insn->chanspec), /* actual PWM data */ data[1], /* just a sign */ (data[2] != 0)); case INSN_CONFIG_PWM_GET_H_BRIDGE: /* values are not kept in this driver, nothing to return here */ return -EINVAL; } return -EINVAL; } /* end of PWM */ /*****************************************************************/ static void tidy_up(struct usbduxsub *usbduxsub_tmp) { int i; if (!usbduxsub_tmp) return; dev_dbg(&usbduxsub_tmp->interface->dev, "comedi_: tiding up\n"); /* shows the usb subsystem that the driver is down */ if (usbduxsub_tmp->interface) usb_set_intfdata(usbduxsub_tmp->interface, NULL); usbduxsub_tmp->probed = 0; if (usbduxsub_tmp->urb_in) { if (usbduxsub_tmp->ai_cmd_running) { usbduxsub_tmp->ai_cmd_running = 0; usbduxsub_unlink_inurbs(usbduxsub_tmp); } for (i = 0; i < usbduxsub_tmp->num_in_buffers; i++) { kfree(usbduxsub_tmp->urb_in[i]->transfer_buffer); usbduxsub_tmp->urb_in[i]->transfer_buffer = NULL; usb_kill_urb(usbduxsub_tmp->urb_in[i]); usb_free_urb(usbduxsub_tmp->urb_in[i]); usbduxsub_tmp->urb_in[i] = NULL; } kfree(usbduxsub_tmp->urb_in); usbduxsub_tmp->urb_in = NULL; } if (usbduxsub_tmp->urb_out) { if (usbduxsub_tmp->ao_cmd_running) { usbduxsub_tmp->ao_cmd_running = 0; usbduxsub_unlink_outurbs(usbduxsub_tmp); } for (i = 0; i < usbduxsub_tmp->num_out_buffers; i++) { kfree(usbduxsub_tmp->urb_out[i]->transfer_buffer); usbduxsub_tmp->urb_out[i]->transfer_buffer = NULL; if (usbduxsub_tmp->urb_out[i]) { usb_kill_urb(usbduxsub_tmp->urb_out[i]); usb_free_urb(usbduxsub_tmp->urb_out[i]); usbduxsub_tmp->urb_out[i] = NULL; } } kfree(usbduxsub_tmp->urb_out); usbduxsub_tmp->urb_out = NULL; } if (usbduxsub_tmp->urb_pwm) { if (usbduxsub_tmp->pwm_cmd_running) { usbduxsub_tmp->pwm_cmd_running = 0; usbduxsub_unlink_pwm_urbs(usbduxsub_tmp); } kfree(usbduxsub_tmp->urb_pwm->transfer_buffer); usbduxsub_tmp->urb_pwm->transfer_buffer = NULL; usb_kill_urb(usbduxsub_tmp->urb_pwm); usb_free_urb(usbduxsub_tmp->urb_pwm); usbduxsub_tmp->urb_pwm = NULL; } kfree(usbduxsub_tmp->in_buffer); usbduxsub_tmp->in_buffer = NULL; kfree(usbduxsub_tmp->insn_buffer); usbduxsub_tmp->insn_buffer = NULL; kfree(usbduxsub_tmp->out_buffer); usbduxsub_tmp->out_buffer = NULL; kfree(usbduxsub_tmp->dac_commands); usbduxsub_tmp->dac_commands = NULL; kfree(usbduxsub_tmp->dux_commands); usbduxsub_tmp->dux_commands = NULL; usbduxsub_tmp->ai_cmd_running = 0; usbduxsub_tmp->ao_cmd_running = 0; usbduxsub_tmp->pwm_cmd_running = 0; } static int usbdux_attach_common(struct comedi_device *dev, struct usbduxsub *udev) { int ret; struct comedi_subdevice *s = NULL; int n_subdevs; down(&udev->sem); /* pointer back to the corresponding comedi device */ udev->comedidev = dev; /* set number of subdevices */ if (udev->high_speed) { /* with pwm */ n_subdevs = 5; } else { /* without pwm */ n_subdevs = 4; } ret = comedi_alloc_subdevices(dev, n_subdevs); if (ret) { up(&udev->sem); return ret; } /* private structure is also simply the usb-structure */ dev->private = udev; /* the first subdevice is the A/D converter */ s = &dev->subdevices[SUBDEV_AD]; /* the URBs get the comedi subdevice */ /* which is responsible for reading */ /* this is the subdevice which reads data */ dev->read_subdev = s; /* the subdevice receives as private structure the */ /* usb-structure */ s->private = NULL; /* analog input */ s->type = COMEDI_SUBD_AI; /* readable and ref is to ground */ s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_CMD_READ; /* 8 channels */ s->n_chan = 8; /* length of the channellist */ s->len_chanlist = 8; /* callback functions */ s->insn_read = usbdux_ai_insn_read; s->do_cmdtest = usbdux_ai_cmdtest; s->do_cmd = usbdux_ai_cmd; s->cancel = usbdux_ai_cancel; /* max value from the A/D converter (12bit) */ s->maxdata = 0xfff; /* range table to convert to physical units */ s->range_table = (&range_usbdux_ai_range); /* analog out */ s = &dev->subdevices[SUBDEV_DA]; /* analog out */ s->type = COMEDI_SUBD_AO; /* backward pointer */ dev->write_subdev = s; /* the subdevice receives as private structure the */ /* usb-structure */ s->private = NULL; /* are writable */ s->subdev_flags = SDF_WRITABLE | SDF_GROUND | SDF_CMD_WRITE; /* 4 channels */ s->n_chan = 4; /* length of the channellist */ s->len_chanlist = 4; /* 12 bit resolution */ s->maxdata = 0x0fff; /* bipolar range */ s->range_table = (&range_usbdux_ao_range); /* callback */ s->do_cmdtest = usbdux_ao_cmdtest; s->do_cmd = usbdux_ao_cmd; s->cancel = usbdux_ao_cancel; s->insn_read = usbdux_ao_insn_read; s->insn_write = usbdux_ao_insn_write; /* digital I/O */ s = &dev->subdevices[SUBDEV_DIO]; s->type = COMEDI_SUBD_DIO; s->subdev_flags = SDF_READABLE | SDF_WRITABLE; s->n_chan = 8; s->maxdata = 1; s->range_table = (&range_digital); s->insn_bits = usbdux_dio_insn_bits; s->insn_config = usbdux_dio_insn_config; /* we don't use it */ s->private = NULL; /* counter */ s = &dev->subdevices[SUBDEV_COUNTER]; s->type = COMEDI_SUBD_COUNTER; s->subdev_flags = SDF_WRITABLE | SDF_READABLE; s->n_chan = 4; s->maxdata = 0xFFFF; s->insn_read = usbdux_counter_read; s->insn_write = usbdux_counter_write; s->insn_config = usbdux_counter_config; if (udev->high_speed) { /* timer / pwm */ s = &dev->subdevices[SUBDEV_PWM]; s->type = COMEDI_SUBD_PWM; s->subdev_flags = SDF_WRITABLE | SDF_PWM_HBRIDGE; s->n_chan = 8; /* this defines the max duty cycle resolution */ s->maxdata = udev->size_pwm_buf; s->insn_write = usbdux_pwm_write; s->insn_read = usbdux_pwm_read; s->insn_config = usbdux_pwm_config; usbdux_pwm_period(dev, s, PWM_DEFAULT_PERIOD); } /* finally decide that it's attached */ udev->attached = 1; up(&udev->sem); dev_info(&udev->interface->dev, "comedi%d: attached to usbdux.\n", dev->minor); return 0; } static int usbdux_auto_attach(struct comedi_device *dev, unsigned long context_unused) { struct usb_interface *uinterf = comedi_to_usb_interface(dev); int ret; struct usbduxsub *this_usbduxsub; dev->private = NULL; down(&start_stop_sem); this_usbduxsub = usb_get_intfdata(uinterf); if (!this_usbduxsub || !this_usbduxsub->probed) { dev_err(dev->class_dev, "usbdux: error: auto_attach failed, not connected\n"); ret = -ENODEV; } else if (this_usbduxsub->attached) { dev_err(dev->class_dev, "error: auto_attach failed, already attached\n"); ret = -ENODEV; } else ret = usbdux_attach_common(dev, this_usbduxsub); up(&start_stop_sem); return ret; } static void usbdux_detach(struct comedi_device *dev) { struct usbduxsub *usb = dev->private; if (usb) { down(&usb->sem); dev->private = NULL; usb->attached = 0; usb->comedidev = NULL; up(&usb->sem); } } static struct comedi_driver usbdux_driver = { .driver_name = "usbdux", .module = THIS_MODULE, .auto_attach = usbdux_auto_attach, .detach = usbdux_detach, }; static void usbdux_firmware_request_complete_handler(const struct firmware *fw, void *context) { struct usbduxsub *usbduxsub_tmp = context; struct usb_interface *uinterf = usbduxsub_tmp->interface; int ret; if (fw == NULL) { dev_err(&uinterf->dev, "Firmware complete handler without firmware!\n"); return; } /* * we need to upload the firmware here because fw will be * freed once we've left this function */ ret = firmware_upload(usbduxsub_tmp, fw->data, fw->size); if (ret) { dev_err(&uinterf->dev, "Could not upload firmware (err=%d)\n", ret); goto out; } comedi_usb_auto_config(uinterf, &usbdux_driver, 0); out: release_firmware(fw); } static int usbdux_usb_probe(struct usb_interface *uinterf, const struct usb_device_id *id) { struct usb_device *udev = interface_to_usbdev(uinterf); struct device *dev = &uinterf->dev; int i; int index; int ret; dev_dbg(dev, "comedi_: usbdux_: " "finding a free structure for the usb-device\n"); down(&start_stop_sem); /* look for a free place in the usbdux array */ index = -1; for (i = 0; i < NUMUSBDUX; i++) { if (!(usbduxsub[i].probed)) { index = i; break; } } /* no more space */ if (index == -1) { dev_err(dev, "Too many usbdux-devices connected.\n"); up(&start_stop_sem); return -EMFILE; } dev_dbg(dev, "comedi_: usbdux: " "usbduxsub[%d] is ready to connect to comedi.\n", index); sema_init(&(usbduxsub[index].sem), 1); /* save a pointer to the usb device */ usbduxsub[index].usbdev = udev; /* 2.6: save the interface itself */ usbduxsub[index].interface = uinterf; /* get the interface number from the interface */ usbduxsub[index].ifnum = uinterf->altsetting->desc.bInterfaceNumber; /* hand the private data over to the usb subsystem */ /* will be needed for disconnect */ usb_set_intfdata(uinterf, &(usbduxsub[index])); dev_dbg(dev, "comedi_: usbdux: ifnum=%d\n", usbduxsub[index].ifnum); /* test if it is high speed (USB 2.0) */ usbduxsub[index].high_speed = (usbduxsub[index].usbdev->speed == USB_SPEED_HIGH); /* create space for the commands of the DA converter */ usbduxsub[index].dac_commands = kzalloc(NUMOUTCHANNELS, GFP_KERNEL); if (!usbduxsub[index].dac_commands) { tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } /* create space for the commands going to the usb device */ usbduxsub[index].dux_commands = kzalloc(SIZEOFDUXBUFFER, GFP_KERNEL); if (!usbduxsub[index].dux_commands) { tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } /* create space for the in buffer and set it to zero */ usbduxsub[index].in_buffer = kzalloc(SIZEINBUF, GFP_KERNEL); if (!(usbduxsub[index].in_buffer)) { tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } /* create space of the instruction buffer */ usbduxsub[index].insn_buffer = kzalloc(SIZEINSNBUF, GFP_KERNEL); if (!(usbduxsub[index].insn_buffer)) { tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } /* create space for the outbuffer */ usbduxsub[index].out_buffer = kzalloc(SIZEOUTBUF, GFP_KERNEL); if (!(usbduxsub[index].out_buffer)) { tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } /* setting to alternate setting 3: enabling iso ep and bulk ep. */ i = usb_set_interface(usbduxsub[index].usbdev, usbduxsub[index].ifnum, 3); if (i < 0) { dev_err(dev, "comedi_: usbdux%d: " "could not set alternate setting 3 in high speed.\n", index); tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENODEV; } if (usbduxsub[index].high_speed) usbduxsub[index].num_in_buffers = NUMOFINBUFFERSHIGH; else usbduxsub[index].num_in_buffers = NUMOFINBUFFERSFULL; usbduxsub[index].urb_in = kcalloc(usbduxsub[index].num_in_buffers, sizeof(struct urb *), GFP_KERNEL); if (!(usbduxsub[index].urb_in)) { tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } for (i = 0; i < usbduxsub[index].num_in_buffers; i++) { /* one frame: 1ms */ usbduxsub[index].urb_in[i] = usb_alloc_urb(1, GFP_KERNEL); if (usbduxsub[index].urb_in[i] == NULL) { dev_err(dev, "comedi_: usbdux%d: " "Could not alloc. urb(%d)\n", index, i); tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } usbduxsub[index].urb_in[i]->dev = usbduxsub[index].usbdev; /* will be filled later with a pointer to the comedi-device */ /* and ONLY then the urb should be submitted */ usbduxsub[index].urb_in[i]->context = NULL; usbduxsub[index].urb_in[i]->pipe = usb_rcvisocpipe(usbduxsub[index].usbdev, ISOINEP); usbduxsub[index].urb_in[i]->transfer_flags = URB_ISO_ASAP; usbduxsub[index].urb_in[i]->transfer_buffer = kzalloc(SIZEINBUF, GFP_KERNEL); if (!(usbduxsub[index].urb_in[i]->transfer_buffer)) { tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } usbduxsub[index].urb_in[i]->complete = usbduxsub_ai_isoc_irq; usbduxsub[index].urb_in[i]->number_of_packets = 1; usbduxsub[index].urb_in[i]->transfer_buffer_length = SIZEINBUF; usbduxsub[index].urb_in[i]->iso_frame_desc[0].offset = 0; usbduxsub[index].urb_in[i]->iso_frame_desc[0].length = SIZEINBUF; } /* out */ if (usbduxsub[index].high_speed) usbduxsub[index].num_out_buffers = NUMOFOUTBUFFERSHIGH; else usbduxsub[index].num_out_buffers = NUMOFOUTBUFFERSFULL; usbduxsub[index].urb_out = kcalloc(usbduxsub[index].num_out_buffers, sizeof(struct urb *), GFP_KERNEL); if (!(usbduxsub[index].urb_out)) { tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } for (i = 0; i < usbduxsub[index].num_out_buffers; i++) { /* one frame: 1ms */ usbduxsub[index].urb_out[i] = usb_alloc_urb(1, GFP_KERNEL); if (usbduxsub[index].urb_out[i] == NULL) { dev_err(dev, "comedi_: usbdux%d: " "Could not alloc. urb(%d)\n", index, i); tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } usbduxsub[index].urb_out[i]->dev = usbduxsub[index].usbdev; /* will be filled later with a pointer to the comedi-device */ /* and ONLY then the urb should be submitted */ usbduxsub[index].urb_out[i]->context = NULL; usbduxsub[index].urb_out[i]->pipe = usb_sndisocpipe(usbduxsub[index].usbdev, ISOOUTEP); usbduxsub[index].urb_out[i]->transfer_flags = URB_ISO_ASAP; usbduxsub[index].urb_out[i]->transfer_buffer = kzalloc(SIZEOUTBUF, GFP_KERNEL); if (!(usbduxsub[index].urb_out[i]->transfer_buffer)) { tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } usbduxsub[index].urb_out[i]->complete = usbduxsub_ao_isoc_irq; usbduxsub[index].urb_out[i]->number_of_packets = 1; usbduxsub[index].urb_out[i]->transfer_buffer_length = SIZEOUTBUF; usbduxsub[index].urb_out[i]->iso_frame_desc[0].offset = 0; usbduxsub[index].urb_out[i]->iso_frame_desc[0].length = SIZEOUTBUF; if (usbduxsub[index].high_speed) { /* uframes */ usbduxsub[index].urb_out[i]->interval = 8; } else { /* frames */ usbduxsub[index].urb_out[i]->interval = 1; } } /* pwm */ if (usbduxsub[index].high_speed) { /* max bulk ep size in high speed */ usbduxsub[index].size_pwm_buf = 512; usbduxsub[index].urb_pwm = usb_alloc_urb(0, GFP_KERNEL); if (usbduxsub[index].urb_pwm == NULL) { dev_err(dev, "comedi_: usbdux%d: " "Could not alloc. pwm urb\n", index); tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } usbduxsub[index].urb_pwm->transfer_buffer = kzalloc(usbduxsub[index].size_pwm_buf, GFP_KERNEL); if (!(usbduxsub[index].urb_pwm->transfer_buffer)) { tidy_up(&(usbduxsub[index])); up(&start_stop_sem); return -ENOMEM; } } else { usbduxsub[index].urb_pwm = NULL; usbduxsub[index].size_pwm_buf = 0; } usbduxsub[index].ai_cmd_running = 0; usbduxsub[index].ao_cmd_running = 0; usbduxsub[index].pwm_cmd_running = 0; /* we've reached the bottom of the function */ usbduxsub[index].probed = 1; up(&start_stop_sem); ret = request_firmware_nowait(THIS_MODULE, FW_ACTION_HOTPLUG, FIRMWARE, &udev->dev, GFP_KERNEL, usbduxsub + index, usbdux_firmware_request_complete_handler); if (ret) { dev_err(dev, "Could not load firmware (err=%d)\n", ret); return ret; } dev_info(dev, "comedi_: usbdux%d " "has been successfully initialised.\n", index); /* success */ return 0; } static void usbdux_usb_disconnect(struct usb_interface *intf) { struct usbduxsub *usbduxsub_tmp = usb_get_intfdata(intf); struct usb_device *udev = interface_to_usbdev(intf); if (!usbduxsub_tmp) { dev_err(&intf->dev, "comedi_: disconnect called with null pointer.\n"); return; } if (usbduxsub_tmp->usbdev != udev) { dev_err(&intf->dev, "comedi_: BUG! called with wrong ptr!!!\n"); return; } comedi_usb_auto_unconfig(intf); down(&start_stop_sem); down(&usbduxsub_tmp->sem); tidy_up(usbduxsub_tmp); up(&usbduxsub_tmp->sem); up(&start_stop_sem); dev_dbg(&intf->dev, "comedi_: disconnected from the usb\n"); } static const struct usb_device_id usbdux_usb_table[] = { { USB_DEVICE(0x13d8, 0x0001) }, { USB_DEVICE(0x13d8, 0x0002) }, { } }; MODULE_DEVICE_TABLE(usb, usbdux_usb_table); static struct usb_driver usbdux_usb_driver = { .name = "usbdux", .probe = usbdux_usb_probe, .disconnect = usbdux_usb_disconnect, .id_table = usbdux_usb_table, }; module_comedi_usb_driver(usbdux_driver, usbdux_usb_driver); MODULE_AUTHOR("Bernd Porr, BerndPorr@f2s.com"); MODULE_DESCRIPTION("Stirling/ITL USB-DUX -- Bernd.Porr@f2s.com"); MODULE_LICENSE("GPL"); MODULE_FIRMWARE(FIRMWARE);