|  | /* | 
|  | * USB Serial Converter Generic functions | 
|  | * | 
|  | * Copyright (C) 1999 - 2002 Greg Kroah-Hartman (greg@kroah.com) | 
|  | * | 
|  | *	This program is free software; you can redistribute it and/or | 
|  | *	modify it under the terms of the GNU General Public License version | 
|  | *	2 as published by the Free Software Foundation. | 
|  | * | 
|  | */ | 
|  |  | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/errno.h> | 
|  | #include <linux/slab.h> | 
|  | #include <linux/tty.h> | 
|  | #include <linux/tty_flip.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/moduleparam.h> | 
|  | #include <linux/usb.h> | 
|  | #include <linux/usb/serial.h> | 
|  | #include <linux/uaccess.h> | 
|  |  | 
|  |  | 
|  | static int debug; | 
|  |  | 
|  | #ifdef CONFIG_USB_SERIAL_GENERIC | 
|  |  | 
|  | static int generic_probe(struct usb_interface *interface, | 
|  | const struct usb_device_id *id); | 
|  |  | 
|  | static __u16 vendor  = 0x05f9; | 
|  | static __u16 product = 0xffff; | 
|  |  | 
|  | module_param(vendor, ushort, 0); | 
|  | MODULE_PARM_DESC(vendor, "User specified USB idVendor"); | 
|  |  | 
|  | module_param(product, ushort, 0); | 
|  | MODULE_PARM_DESC(product, "User specified USB idProduct"); | 
|  |  | 
|  | static struct usb_device_id generic_device_ids[2]; /* Initially all zeroes. */ | 
|  |  | 
|  | /* we want to look at all devices, as the vendor/product id can change | 
|  | * depending on the command line argument */ | 
|  | static struct usb_device_id generic_serial_ids[] = { | 
|  | {.driver_info = 42}, | 
|  | {} | 
|  | }; | 
|  |  | 
|  | static struct usb_driver generic_driver = { | 
|  | .name =		"usbserial_generic", | 
|  | .probe =	generic_probe, | 
|  | .disconnect =	usb_serial_disconnect, | 
|  | .id_table =	generic_serial_ids, | 
|  | .no_dynamic_id =	1, | 
|  | }; | 
|  |  | 
|  | /* All of the device info needed for the Generic Serial Converter */ | 
|  | struct usb_serial_driver usb_serial_generic_device = { | 
|  | .driver = { | 
|  | .owner =	THIS_MODULE, | 
|  | .name =		"generic", | 
|  | }, | 
|  | .id_table =		generic_device_ids, | 
|  | .usb_driver = 		&generic_driver, | 
|  | .num_ports =		1, | 
|  | .shutdown =		usb_serial_generic_shutdown, | 
|  | .throttle =		usb_serial_generic_throttle, | 
|  | .unthrottle =		usb_serial_generic_unthrottle, | 
|  | .resume =		usb_serial_generic_resume, | 
|  | }; | 
|  |  | 
|  | static int generic_probe(struct usb_interface *interface, | 
|  | const struct usb_device_id *id) | 
|  | { | 
|  | const struct usb_device_id *id_pattern; | 
|  |  | 
|  | id_pattern = usb_match_id(interface, generic_device_ids); | 
|  | if (id_pattern != NULL) | 
|  | return usb_serial_probe(interface, id); | 
|  | return -ENODEV; | 
|  | } | 
|  | #endif | 
|  |  | 
|  | int usb_serial_generic_register(int _debug) | 
|  | { | 
|  | int retval = 0; | 
|  |  | 
|  | debug = _debug; | 
|  | #ifdef CONFIG_USB_SERIAL_GENERIC | 
|  | generic_device_ids[0].idVendor = vendor; | 
|  | generic_device_ids[0].idProduct = product; | 
|  | generic_device_ids[0].match_flags = | 
|  | USB_DEVICE_ID_MATCH_VENDOR | USB_DEVICE_ID_MATCH_PRODUCT; | 
|  |  | 
|  | /* register our generic driver with ourselves */ | 
|  | retval = usb_serial_register(&usb_serial_generic_device); | 
|  | if (retval) | 
|  | goto exit; | 
|  | retval = usb_register(&generic_driver); | 
|  | if (retval) | 
|  | usb_serial_deregister(&usb_serial_generic_device); | 
|  | exit: | 
|  | #endif | 
|  | return retval; | 
|  | } | 
|  |  | 
|  | void usb_serial_generic_deregister(void) | 
|  | { | 
|  | #ifdef CONFIG_USB_SERIAL_GENERIC | 
|  | /* remove our generic driver */ | 
|  | usb_deregister(&generic_driver); | 
|  | usb_serial_deregister(&usb_serial_generic_device); | 
|  | #endif | 
|  | } | 
|  |  | 
|  | int usb_serial_generic_open(struct tty_struct *tty, | 
|  | struct usb_serial_port *port, struct file *filp) | 
|  | { | 
|  | struct usb_serial *serial = port->serial; | 
|  | int result = 0; | 
|  | unsigned long flags; | 
|  |  | 
|  | dbg("%s - port %d", __func__, port->number); | 
|  |  | 
|  | /* force low_latency on so that our tty_push actually forces the data | 
|  | through, otherwise it is scheduled, and with high data rates (like | 
|  | with OHCI) data can get lost. */ | 
|  | if (tty) | 
|  | tty->low_latency = 1; | 
|  |  | 
|  | /* clear the throttle flags */ | 
|  | spin_lock_irqsave(&port->lock, flags); | 
|  | port->throttled = 0; | 
|  | port->throttle_req = 0; | 
|  | spin_unlock_irqrestore(&port->lock, flags); | 
|  |  | 
|  | /* if we have a bulk endpoint, start reading from it */ | 
|  | if (serial->num_bulk_in) { | 
|  | /* Start reading from the device */ | 
|  | usb_fill_bulk_urb(port->read_urb, serial->dev, | 
|  | usb_rcvbulkpipe(serial->dev, | 
|  | port->bulk_in_endpointAddress), | 
|  | port->read_urb->transfer_buffer, | 
|  | port->read_urb->transfer_buffer_length, | 
|  | ((serial->type->read_bulk_callback) ? | 
|  | serial->type->read_bulk_callback : | 
|  | usb_serial_generic_read_bulk_callback), | 
|  | port); | 
|  | result = usb_submit_urb(port->read_urb, GFP_KERNEL); | 
|  | if (result) | 
|  | dev_err(&port->dev, | 
|  | "%s - failed resubmitting read urb, error %d\n", | 
|  | __func__, result); | 
|  | } | 
|  |  | 
|  | return result; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(usb_serial_generic_open); | 
|  |  | 
|  | static void generic_cleanup(struct usb_serial_port *port) | 
|  | { | 
|  | struct usb_serial *serial = port->serial; | 
|  |  | 
|  | dbg("%s - port %d", __func__, port->number); | 
|  |  | 
|  | if (serial->dev) { | 
|  | /* shutdown any bulk reads that might be going on */ | 
|  | if (serial->num_bulk_out) | 
|  | usb_kill_urb(port->write_urb); | 
|  | if (serial->num_bulk_in) | 
|  | usb_kill_urb(port->read_urb); | 
|  | } | 
|  | } | 
|  |  | 
|  | int usb_serial_generic_resume(struct usb_serial *serial) | 
|  | { | 
|  | struct usb_serial_port *port; | 
|  | int i, c = 0, r; | 
|  |  | 
|  | for (i = 0; i < serial->num_ports; i++) { | 
|  | port = serial->port[i]; | 
|  | if (port->port.count && port->read_urb) { | 
|  | r = usb_submit_urb(port->read_urb, GFP_NOIO); | 
|  | if (r < 0) | 
|  | c++; | 
|  | } | 
|  | } | 
|  |  | 
|  | return c ? -EIO : 0; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(usb_serial_generic_resume); | 
|  |  | 
|  | void usb_serial_generic_close(struct tty_struct *tty, | 
|  | struct usb_serial_port *port, struct file *filp) | 
|  | { | 
|  | dbg("%s - port %d", __func__, port->number); | 
|  | generic_cleanup(port); | 
|  | } | 
|  |  | 
|  | int usb_serial_generic_write(struct tty_struct *tty, | 
|  | struct usb_serial_port *port, const unsigned char *buf, int count) | 
|  | { | 
|  | struct usb_serial *serial = port->serial; | 
|  | int result; | 
|  | unsigned char *data; | 
|  |  | 
|  | dbg("%s - port %d", __func__, port->number); | 
|  |  | 
|  | if (count == 0) { | 
|  | dbg("%s - write request of 0 bytes", __func__); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* only do something if we have a bulk out endpoint */ | 
|  | if (serial->num_bulk_out) { | 
|  | unsigned long flags; | 
|  | spin_lock_irqsave(&port->lock, flags); | 
|  | if (port->write_urb_busy) { | 
|  | spin_unlock_irqrestore(&port->lock, flags); | 
|  | dbg("%s - already writing", __func__); | 
|  | return 0; | 
|  | } | 
|  | port->write_urb_busy = 1; | 
|  | spin_unlock_irqrestore(&port->lock, flags); | 
|  |  | 
|  | count = (count > port->bulk_out_size) ? | 
|  | port->bulk_out_size : count; | 
|  |  | 
|  | memcpy(port->write_urb->transfer_buffer, buf, count); | 
|  | data = port->write_urb->transfer_buffer; | 
|  | usb_serial_debug_data(debug, &port->dev, __func__, count, data); | 
|  |  | 
|  | /* set up our urb */ | 
|  | usb_fill_bulk_urb(port->write_urb, serial->dev, | 
|  | usb_sndbulkpipe(serial->dev, | 
|  | port->bulk_out_endpointAddress), | 
|  | port->write_urb->transfer_buffer, count, | 
|  | ((serial->type->write_bulk_callback) ? | 
|  | serial->type->write_bulk_callback : | 
|  | usb_serial_generic_write_bulk_callback), | 
|  | port); | 
|  |  | 
|  | /* send the data out the bulk port */ | 
|  | port->write_urb_busy = 1; | 
|  | result = usb_submit_urb(port->write_urb, GFP_ATOMIC); | 
|  | if (result) { | 
|  | dev_err(&port->dev, | 
|  | "%s - failed submitting write urb, error %d\n", | 
|  | __func__, result); | 
|  | /* don't have to grab the lock here, as we will | 
|  | retry if != 0 */ | 
|  | port->write_urb_busy = 0; | 
|  | } else | 
|  | result = count; | 
|  |  | 
|  | return result; | 
|  | } | 
|  |  | 
|  | /* no bulk out, so return 0 bytes written */ | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | int usb_serial_generic_write_room(struct tty_struct *tty) | 
|  | { | 
|  | struct usb_serial_port *port = tty->driver_data; | 
|  | struct usb_serial *serial = port->serial; | 
|  | int room = 0; | 
|  |  | 
|  | dbg("%s - port %d", __func__, port->number); | 
|  |  | 
|  | /* FIXME: Locking */ | 
|  | if (serial->num_bulk_out) { | 
|  | if (!(port->write_urb_busy)) | 
|  | room = port->bulk_out_size; | 
|  | } | 
|  |  | 
|  | dbg("%s - returns %d", __func__, room); | 
|  | return room; | 
|  | } | 
|  |  | 
|  | int usb_serial_generic_chars_in_buffer(struct tty_struct *tty) | 
|  | { | 
|  | struct usb_serial_port *port = tty->driver_data; | 
|  | struct usb_serial *serial = port->serial; | 
|  | int chars = 0; | 
|  |  | 
|  | dbg("%s - port %d", __func__, port->number); | 
|  |  | 
|  | /* FIXME: Locking */ | 
|  | if (serial->num_bulk_out) { | 
|  | if (port->write_urb_busy) | 
|  | chars = port->write_urb->transfer_buffer_length; | 
|  | } | 
|  |  | 
|  | dbg("%s - returns %d", __func__, chars); | 
|  | return chars; | 
|  | } | 
|  |  | 
|  |  | 
|  | static void resubmit_read_urb(struct usb_serial_port *port, gfp_t mem_flags) | 
|  | { | 
|  | struct urb *urb = port->read_urb; | 
|  | struct usb_serial *serial = port->serial; | 
|  | int result; | 
|  |  | 
|  | /* Continue reading from device */ | 
|  | usb_fill_bulk_urb(urb, serial->dev, | 
|  | usb_rcvbulkpipe(serial->dev, | 
|  | port->bulk_in_endpointAddress), | 
|  | urb->transfer_buffer, | 
|  | urb->transfer_buffer_length, | 
|  | ((serial->type->read_bulk_callback) ? | 
|  | serial->type->read_bulk_callback : | 
|  | usb_serial_generic_read_bulk_callback), port); | 
|  | result = usb_submit_urb(urb, mem_flags); | 
|  | if (result) | 
|  | dev_err(&port->dev, | 
|  | "%s - failed resubmitting read urb, error %d\n", | 
|  | __func__, result); | 
|  | } | 
|  |  | 
|  | /* Push data to tty layer and resubmit the bulk read URB */ | 
|  | static void flush_and_resubmit_read_urb(struct usb_serial_port *port) | 
|  | { | 
|  | struct urb *urb = port->read_urb; | 
|  | struct tty_struct *tty = tty_port_tty_get(&port->port); | 
|  | int room; | 
|  |  | 
|  | /* Push data to tty */ | 
|  | if (tty && urb->actual_length) { | 
|  | room = tty_buffer_request_room(tty, urb->actual_length); | 
|  | if (room) { | 
|  | tty_insert_flip_string(tty, urb->transfer_buffer, room); | 
|  | tty_flip_buffer_push(tty); | 
|  | } | 
|  | } | 
|  | tty_kref_put(tty); | 
|  |  | 
|  | resubmit_read_urb(port, GFP_ATOMIC); | 
|  | } | 
|  |  | 
|  | void usb_serial_generic_read_bulk_callback(struct urb *urb) | 
|  | { | 
|  | struct usb_serial_port *port = urb->context; | 
|  | unsigned char *data = urb->transfer_buffer; | 
|  | int status = urb->status; | 
|  | unsigned long flags; | 
|  |  | 
|  | dbg("%s - port %d", __func__, port->number); | 
|  |  | 
|  | if (unlikely(status != 0)) { | 
|  | dbg("%s - nonzero read bulk status received: %d", | 
|  | __func__, status); | 
|  | return; | 
|  | } | 
|  |  | 
|  | usb_serial_debug_data(debug, &port->dev, __func__, | 
|  | urb->actual_length, data); | 
|  |  | 
|  | /* Throttle the device if requested by tty */ | 
|  | spin_lock_irqsave(&port->lock, flags); | 
|  | port->throttled = port->throttle_req; | 
|  | if (!port->throttled) { | 
|  | spin_unlock_irqrestore(&port->lock, flags); | 
|  | flush_and_resubmit_read_urb(port); | 
|  | } else | 
|  | spin_unlock_irqrestore(&port->lock, flags); | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(usb_serial_generic_read_bulk_callback); | 
|  |  | 
|  | void usb_serial_generic_write_bulk_callback(struct urb *urb) | 
|  | { | 
|  | struct usb_serial_port *port = urb->context; | 
|  | int status = urb->status; | 
|  |  | 
|  | dbg("%s - port %d", __func__, port->number); | 
|  |  | 
|  | port->write_urb_busy = 0; | 
|  | if (status) { | 
|  | dbg("%s - nonzero write bulk status received: %d", | 
|  | __func__, status); | 
|  | return; | 
|  | } | 
|  | usb_serial_port_softint(port); | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(usb_serial_generic_write_bulk_callback); | 
|  |  | 
|  | void usb_serial_generic_throttle(struct tty_struct *tty) | 
|  | { | 
|  | struct usb_serial_port *port = tty->driver_data; | 
|  | unsigned long flags; | 
|  |  | 
|  | dbg("%s - port %d", __func__, port->number); | 
|  |  | 
|  | /* Set the throttle request flag. It will be picked up | 
|  | * by usb_serial_generic_read_bulk_callback(). */ | 
|  | spin_lock_irqsave(&port->lock, flags); | 
|  | port->throttle_req = 1; | 
|  | spin_unlock_irqrestore(&port->lock, flags); | 
|  | } | 
|  |  | 
|  | void usb_serial_generic_unthrottle(struct tty_struct *tty) | 
|  | { | 
|  | struct usb_serial_port *port = tty->driver_data; | 
|  | int was_throttled; | 
|  | unsigned long flags; | 
|  |  | 
|  | dbg("%s - port %d", __func__, port->number); | 
|  |  | 
|  | /* Clear the throttle flags */ | 
|  | spin_lock_irqsave(&port->lock, flags); | 
|  | was_throttled = port->throttled; | 
|  | port->throttled = port->throttle_req = 0; | 
|  | spin_unlock_irqrestore(&port->lock, flags); | 
|  |  | 
|  | if (was_throttled) { | 
|  | /* Resume reading from device */ | 
|  | resubmit_read_urb(port, GFP_KERNEL); | 
|  | } | 
|  | } | 
|  |  | 
|  | void usb_serial_generic_shutdown(struct usb_serial *serial) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | dbg("%s", __func__); | 
|  |  | 
|  | /* stop reads and writes on all ports */ | 
|  | for (i = 0; i < serial->num_ports; ++i) | 
|  | generic_cleanup(serial->port[i]); | 
|  | } | 
|  |  |