aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/usb/serial/generic.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/usb/serial/generic.c')
-rw-r--r--drivers/usb/serial/generic.c150
1 files changed, 22 insertions, 128 deletions
diff --git a/drivers/usb/serial/generic.c b/drivers/usb/serial/generic.c
index 3ae17840175c..fcd30b841559 100644
--- a/drivers/usb/serial/generic.c
+++ b/drivers/usb/serial/generic.c
@@ -26,8 +26,6 @@
26 26
27static int debug; 27static int debug;
28 28
29#define MAX_TX_URBS 40
30
31#ifdef CONFIG_USB_SERIAL_GENERIC 29#ifdef CONFIG_USB_SERIAL_GENERIC
32 30
33static int generic_probe(struct usb_interface *interface, 31static int generic_probe(struct usb_interface *interface,
@@ -172,90 +170,9 @@ void usb_serial_generic_close(struct usb_serial_port *port)
172EXPORT_SYMBOL_GPL(usb_serial_generic_close); 170EXPORT_SYMBOL_GPL(usb_serial_generic_close);
173 171
174int usb_serial_generic_prepare_write_buffer(struct usb_serial_port *port, 172int usb_serial_generic_prepare_write_buffer(struct usb_serial_port *port,
175 void **dest, size_t size, const void *src, size_t count) 173 void *dest, size_t size)
176{ 174{
177 if (!*dest) { 175 return kfifo_out_locked(&port->write_fifo, dest, size, &port->lock);
178 size = count;
179 *dest = kmalloc(count, GFP_ATOMIC);
180 if (!*dest) {
181 dev_err(&port->dev, "%s - could not allocate buffer\n",
182 __func__);
183 return -ENOMEM;
184 }
185 }
186 if (src) {
187 count = size;
188 memcpy(*dest, src, size);
189 } else {
190 count = kfifo_out_locked(&port->write_fifo, *dest, size,
191 &port->lock);
192 }
193 return count;
194}
195EXPORT_SYMBOL_GPL(usb_serial_generic_prepare_write_buffer);
196
197static int usb_serial_multi_urb_write(struct tty_struct *tty,
198 struct usb_serial_port *port, const unsigned char *buf, int count)
199{
200 unsigned long flags;
201 struct urb *urb;
202 void *buffer;
203 int status;
204
205 spin_lock_irqsave(&port->lock, flags);
206 if (port->tx_urbs == MAX_TX_URBS) {
207 spin_unlock_irqrestore(&port->lock, flags);
208 dbg("%s - write limit hit", __func__);
209 return 0;
210 }
211 port->tx_urbs++;
212 spin_unlock_irqrestore(&port->lock, flags);
213
214 urb = usb_alloc_urb(0, GFP_ATOMIC);
215 if (!urb) {
216 dev_err(&port->dev, "%s - no free urbs available\n", __func__);
217 status = -ENOMEM;
218 goto err_urb;
219 }
220
221 buffer = NULL;
222 count = min_t(int, count, PAGE_SIZE);
223 count = port->serial->type->prepare_write_buffer(port, &buffer, 0,
224 buf, count);
225 if (count < 0) {
226 status = count;
227 goto err_buf;
228 }
229 usb_serial_debug_data(debug, &port->dev, __func__, count, buffer);
230 usb_fill_bulk_urb(urb, port->serial->dev,
231 usb_sndbulkpipe(port->serial->dev,
232 port->bulk_out_endpointAddress),
233 buffer, count,
234 port->serial->type->write_bulk_callback, port);
235
236 status = usb_submit_urb(urb, GFP_ATOMIC);
237 if (status) {
238 dev_err(&port->dev, "%s - error submitting urb: %d\n",
239 __func__, status);
240 goto err;
241 }
242 spin_lock_irqsave(&port->lock, flags);
243 port->tx_bytes += urb->transfer_buffer_length;
244 spin_unlock_irqrestore(&port->lock, flags);
245
246 usb_free_urb(urb);
247
248 return count;
249err:
250 kfree(buffer);
251err_buf:
252 usb_free_urb(urb);
253err_urb:
254 spin_lock_irqsave(&port->lock, flags);
255 port->tx_urbs--;
256 spin_unlock_irqrestore(&port->lock, flags);
257
258 return status;
259} 176}
260 177
261/** 178/**
@@ -286,8 +203,8 @@ retry:
286 203
287 urb = port->write_urbs[i]; 204 urb = port->write_urbs[i];
288 count = port->serial->type->prepare_write_buffer(port, 205 count = port->serial->type->prepare_write_buffer(port,
289 &urb->transfer_buffer, 206 urb->transfer_buffer,
290 port->bulk_out_size, NULL, 0); 207 port->bulk_out_size);
291 urb->transfer_buffer_length = count; 208 urb->transfer_buffer_length = count;
292 usb_serial_debug_data(debug, &port->dev, __func__, count, 209 usb_serial_debug_data(debug, &port->dev, __func__, count,
293 urb->transfer_buffer); 210 urb->transfer_buffer);
@@ -328,7 +245,6 @@ retry:
328int usb_serial_generic_write(struct tty_struct *tty, 245int usb_serial_generic_write(struct tty_struct *tty,
329 struct usb_serial_port *port, const unsigned char *buf, int count) 246 struct usb_serial_port *port, const unsigned char *buf, int count)
330{ 247{
331 struct usb_serial *serial = port->serial;
332 int result; 248 int result;
333 249
334 dbg("%s - port %d", __func__, port->number); 250 dbg("%s - port %d", __func__, port->number);
@@ -340,23 +256,18 @@ int usb_serial_generic_write(struct tty_struct *tty,
340 if (!count) 256 if (!count)
341 return 0; 257 return 0;
342 258
343 if (serial->type->multi_urb_write)
344 return usb_serial_multi_urb_write(tty, port, buf, count);
345
346 count = kfifo_in_locked(&port->write_fifo, buf, count, &port->lock); 259 count = kfifo_in_locked(&port->write_fifo, buf, count, &port->lock);
347 result = usb_serial_generic_write_start(port); 260 result = usb_serial_generic_write_start(port);
261 if (result)
262 return result;
348 263
349 if (result >= 0) 264 return count;
350 result = count;
351
352 return result;
353} 265}
354EXPORT_SYMBOL_GPL(usb_serial_generic_write); 266EXPORT_SYMBOL_GPL(usb_serial_generic_write);
355 267
356int usb_serial_generic_write_room(struct tty_struct *tty) 268int usb_serial_generic_write_room(struct tty_struct *tty)
357{ 269{
358 struct usb_serial_port *port = tty->driver_data; 270 struct usb_serial_port *port = tty->driver_data;
359 struct usb_serial *serial = port->serial;
360 unsigned long flags; 271 unsigned long flags;
361 int room; 272 int room;
362 273
@@ -366,10 +277,7 @@ int usb_serial_generic_write_room(struct tty_struct *tty)
366 return 0; 277 return 0;
367 278
368 spin_lock_irqsave(&port->lock, flags); 279 spin_lock_irqsave(&port->lock, flags);
369 if (serial->type->multi_urb_write) 280 room = kfifo_avail(&port->write_fifo);
370 room = (MAX_TX_URBS - port->tx_urbs) * PAGE_SIZE;
371 else
372 room = kfifo_avail(&port->write_fifo);
373 spin_unlock_irqrestore(&port->lock, flags); 281 spin_unlock_irqrestore(&port->lock, flags);
374 282
375 dbg("%s - returns %d", __func__, room); 283 dbg("%s - returns %d", __func__, room);
@@ -379,7 +287,6 @@ int usb_serial_generic_write_room(struct tty_struct *tty)
379int usb_serial_generic_chars_in_buffer(struct tty_struct *tty) 287int usb_serial_generic_chars_in_buffer(struct tty_struct *tty)
380{ 288{
381 struct usb_serial_port *port = tty->driver_data; 289 struct usb_serial_port *port = tty->driver_data;
382 struct usb_serial *serial = port->serial;
383 unsigned long flags; 290 unsigned long flags;
384 int chars; 291 int chars;
385 292
@@ -389,10 +296,7 @@ int usb_serial_generic_chars_in_buffer(struct tty_struct *tty)
389 return 0; 296 return 0;
390 297
391 spin_lock_irqsave(&port->lock, flags); 298 spin_lock_irqsave(&port->lock, flags);
392 if (serial->type->multi_urb_write) 299 chars = kfifo_len(&port->write_fifo) + port->tx_bytes;
393 chars = port->tx_bytes;
394 else
395 chars = kfifo_len(&port->write_fifo) + port->tx_bytes;
396 spin_unlock_irqrestore(&port->lock, flags); 300 spin_unlock_irqrestore(&port->lock, flags);
397 301
398 dbg("%s - returns %d", __func__, chars); 302 dbg("%s - returns %d", __func__, chars);
@@ -479,35 +383,25 @@ void usb_serial_generic_write_bulk_callback(struct urb *urb)
479 383
480 dbg("%s - port %d", __func__, port->number); 384 dbg("%s - port %d", __func__, port->number);
481 385
482 if (port->serial->type->multi_urb_write) { 386 for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i)
483 kfree(urb->transfer_buffer); 387 if (port->write_urbs[i] == urb)
388 break;
484 389
485 spin_lock_irqsave(&port->lock, flags); 390 spin_lock_irqsave(&port->lock, flags);
486 port->tx_bytes -= urb->transfer_buffer_length; 391 port->tx_bytes -= urb->transfer_buffer_length;
487 port->tx_urbs--; 392 set_bit(i, &port->write_urbs_free);
488 spin_unlock_irqrestore(&port->lock, flags); 393 spin_unlock_irqrestore(&port->lock, flags);
489 } else { 394
490 for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i) 395 if (status) {
491 if (port->write_urbs[i] == urb) 396 dbg("%s - non-zero urb status: %d", __func__, status);
492 break;
493 397
494 spin_lock_irqsave(&port->lock, flags); 398 spin_lock_irqsave(&port->lock, flags);
495 port->tx_bytes -= urb->transfer_buffer_length; 399 kfifo_reset_out(&port->write_fifo);
496 set_bit(i, &port->write_urbs_free);
497 spin_unlock_irqrestore(&port->lock, flags); 400 spin_unlock_irqrestore(&port->lock, flags);
498 401 } else {
499 if (status) { 402 usb_serial_generic_write_start(port);
500 spin_lock_irqsave(&port->lock, flags);
501 kfifo_reset_out(&port->write_fifo);
502 spin_unlock_irqrestore(&port->lock, flags);
503 } else {
504 usb_serial_generic_write_start(port);
505 }
506 } 403 }
507 404
508 if (status)
509 dbg("%s - non-zero urb status: %d", __func__, status);
510
511 usb_serial_port_softint(port); 405 usb_serial_port_softint(port);
512} 406}
513EXPORT_SYMBOL_GPL(usb_serial_generic_write_bulk_callback); 407EXPORT_SYMBOL_GPL(usb_serial_generic_write_bulk_callback);