Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * USB Serial Converter Generic functions | |
3 | * | |
659597b7 | 4 | * Copyright (C) 2010 - 2013 Johan Hovold (jhovold@gmail.com) |
1da177e4 LT |
5 | * Copyright (C) 1999 - 2002 Greg Kroah-Hartman (greg@kroah.com) |
6 | * | |
7 | * This program is free software; you can redistribute it and/or | |
8 | * modify it under the terms of the GNU General Public License version | |
9 | * 2 as published by the Free Software Foundation. | |
1da177e4 LT |
10 | */ |
11 | ||
1da177e4 LT |
12 | #include <linux/kernel.h> |
13 | #include <linux/errno.h> | |
14 | #include <linux/slab.h> | |
7f0ae3a8 | 15 | #include <linux/sysrq.h> |
1da177e4 LT |
16 | #include <linux/tty.h> |
17 | #include <linux/tty_flip.h> | |
18 | #include <linux/module.h> | |
19 | #include <linux/moduleparam.h> | |
20 | #include <linux/usb.h> | |
a969888c | 21 | #include <linux/usb/serial.h> |
ae64387a | 22 | #include <linux/uaccess.h> |
8e8dce06 | 23 | #include <linux/kfifo.h> |
1f87158e | 24 | #include <linux/serial.h> |
d9b1b787 | 25 | |
1da177e4 | 26 | #ifdef CONFIG_USB_SERIAL_GENERIC |
b46d60fc | 27 | |
1da177e4 LT |
28 | static __u16 vendor = 0x05f9; |
29 | static __u16 product = 0xffff; | |
30 | ||
31 | module_param(vendor, ushort, 0); | |
32 | MODULE_PARM_DESC(vendor, "User specified USB idVendor"); | |
33 | ||
34 | module_param(product, ushort, 0); | |
35 | MODULE_PARM_DESC(product, "User specified USB idProduct"); | |
36 | ||
37 | static struct usb_device_id generic_device_ids[2]; /* Initially all zeroes. */ | |
38 | ||
ea65370d | 39 | struct usb_serial_driver usb_serial_generic_device = { |
18fcac35 GKH |
40 | .driver = { |
41 | .owner = THIS_MODULE, | |
269bda1c | 42 | .name = "generic", |
18fcac35 | 43 | }, |
1da177e4 | 44 | .id_table = generic_device_ids, |
1da177e4 | 45 | .num_ports = 1, |
253ca923 JR |
46 | .throttle = usb_serial_generic_throttle, |
47 | .unthrottle = usb_serial_generic_unthrottle, | |
ec22559e | 48 | .resume = usb_serial_generic_resume, |
1da177e4 LT |
49 | }; |
50 | ||
765e0ba6 AS |
51 | static struct usb_serial_driver * const serial_drivers[] = { |
52 | &usb_serial_generic_device, NULL | |
53 | }; | |
54 | ||
1da177e4 LT |
55 | #endif |
56 | ||
3033bc8d | 57 | int usb_serial_generic_register(void) |
1da177e4 LT |
58 | { |
59 | int retval = 0; | |
60 | ||
1da177e4 LT |
61 | #ifdef CONFIG_USB_SERIAL_GENERIC |
62 | generic_device_ids[0].idVendor = vendor; | |
63 | generic_device_ids[0].idProduct = product; | |
ae64387a AC |
64 | generic_device_ids[0].match_flags = |
65 | USB_DEVICE_ID_MATCH_VENDOR | USB_DEVICE_ID_MATCH_PRODUCT; | |
1da177e4 | 66 | |
0b84704a AS |
67 | retval = usb_serial_register_drivers(serial_drivers, |
68 | "usbserial_generic", generic_device_ids); | |
1da177e4 LT |
69 | #endif |
70 | return retval; | |
71 | } | |
72 | ||
ae64387a | 73 | void usb_serial_generic_deregister(void) |
1da177e4 LT |
74 | { |
75 | #ifdef CONFIG_USB_SERIAL_GENERIC | |
68e24113 | 76 | usb_serial_deregister_drivers(serial_drivers); |
1da177e4 LT |
77 | #endif |
78 | } | |
79 | ||
a509a7e4 | 80 | int usb_serial_generic_open(struct tty_struct *tty, struct usb_serial_port *port) |
1da177e4 | 81 | { |
1da177e4 | 82 | int result = 0; |
253ca923 | 83 | unsigned long flags; |
1da177e4 | 84 | |
253ca923 JR |
85 | spin_lock_irqsave(&port->lock, flags); |
86 | port->throttled = 0; | |
87 | port->throttle_req = 0; | |
88 | spin_unlock_irqrestore(&port->lock, flags); | |
89 | ||
41bd72f9 | 90 | if (port->bulk_in_size) |
d83b4053 | 91 | result = usb_serial_generic_submit_read_urbs(port, GFP_KERNEL); |
1da177e4 LT |
92 | |
93 | return result; | |
94 | } | |
815ddc99 | 95 | EXPORT_SYMBOL_GPL(usb_serial_generic_open); |
1da177e4 | 96 | |
f8f0ad86 | 97 | void usb_serial_generic_close(struct usb_serial_port *port) |
1da177e4 | 98 | { |
ec3ee508 | 99 | unsigned long flags; |
27c7acf2 | 100 | int i; |
1da177e4 | 101 | |
19c61853 JH |
102 | if (port->bulk_out_size) { |
103 | for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i) | |
104 | usb_kill_urb(port->write_urbs[i]); | |
105 | ||
106 | spin_lock_irqsave(&port->lock, flags); | |
107 | kfifo_reset_out(&port->write_fifo); | |
108 | spin_unlock_irqrestore(&port->lock, flags); | |
109 | } | |
110 | if (port->bulk_in_size) { | |
111 | for (i = 0; i < ARRAY_SIZE(port->read_urbs); ++i) | |
112 | usb_kill_urb(port->read_urbs[i]); | |
1da177e4 LT |
113 | } |
114 | } | |
f26788da | 115 | EXPORT_SYMBOL_GPL(usb_serial_generic_close); |
1da177e4 | 116 | |
eaa3bcb0 | 117 | int usb_serial_generic_prepare_write_buffer(struct usb_serial_port *port, |
c23e5fc1 | 118 | void *dest, size_t size) |
eaa3bcb0 | 119 | { |
c23e5fc1 | 120 | return kfifo_out_locked(&port->write_fifo, dest, size, &port->lock); |
715b1dc0 JW |
121 | } |
122 | ||
8e8dce06 | 123 | /** |
92ad2479 JH |
124 | * usb_serial_generic_write_start - start writing buffered data |
125 | * @port: usb-serial port | |
818f6036 | 126 | * @mem_flags: flags to use for memory allocations |
92ad2479 JH |
127 | * |
128 | * Serialised using USB_SERIAL_WRITE_BUSY flag. | |
8e8dce06 | 129 | * |
92ad2479 | 130 | * Return: Zero on success or if busy, otherwise a negative errno value. |
8e8dce06 | 131 | */ |
706cd17e | 132 | int usb_serial_generic_write_start(struct usb_serial_port *port, |
818f6036 | 133 | gfp_t mem_flags) |
8e8dce06 | 134 | { |
27c7acf2 JH |
135 | struct urb *urb; |
136 | int count, result; | |
8e8dce06 | 137 | unsigned long flags; |
27c7acf2 | 138 | int i; |
8e8dce06 | 139 | |
27c7acf2 JH |
140 | if (test_and_set_bit_lock(USB_SERIAL_WRITE_BUSY, &port->flags)) |
141 | return 0; | |
142 | retry: | |
8e8dce06 | 143 | spin_lock_irqsave(&port->lock, flags); |
27c7acf2 JH |
144 | if (!port->write_urbs_free || !kfifo_len(&port->write_fifo)) { |
145 | clear_bit_unlock(USB_SERIAL_WRITE_BUSY, &port->flags); | |
50a5f70c JH |
146 | spin_unlock_irqrestore(&port->lock, flags); |
147 | return 0; | |
8e8dce06 | 148 | } |
27c7acf2 JH |
149 | i = (int)find_first_bit(&port->write_urbs_free, |
150 | ARRAY_SIZE(port->write_urbs)); | |
8e8dce06 DV |
151 | spin_unlock_irqrestore(&port->lock, flags); |
152 | ||
27c7acf2 | 153 | urb = port->write_urbs[i]; |
eaa3bcb0 | 154 | count = port->serial->type->prepare_write_buffer(port, |
c23e5fc1 JH |
155 | urb->transfer_buffer, |
156 | port->bulk_out_size); | |
27c7acf2 | 157 | urb->transfer_buffer_length = count; |
59d33f2f | 158 | usb_serial_debug_data(&port->dev, __func__, count, urb->transfer_buffer); |
b58af406 JH |
159 | spin_lock_irqsave(&port->lock, flags); |
160 | port->tx_bytes += count; | |
161 | spin_unlock_irqrestore(&port->lock, flags); | |
162 | ||
163 | clear_bit(i, &port->write_urbs_free); | |
818f6036 | 164 | result = usb_submit_urb(urb, mem_flags); |
8e8dce06 | 165 | if (result) { |
f1475a00 | 166 | dev_err_console(port, "%s - error submitting urb: %d\n", |
8e8dce06 | 167 | __func__, result); |
b58af406 JH |
168 | set_bit(i, &port->write_urbs_free); |
169 | spin_lock_irqsave(&port->lock, flags); | |
170 | port->tx_bytes -= count; | |
171 | spin_unlock_irqrestore(&port->lock, flags); | |
172 | ||
27c7acf2 | 173 | clear_bit_unlock(USB_SERIAL_WRITE_BUSY, &port->flags); |
30af7fb5 JH |
174 | return result; |
175 | } | |
27c7acf2 | 176 | |
6f648546 | 177 | goto retry; /* try sending off another urb */ |
8e8dce06 | 178 | } |
706cd17e | 179 | EXPORT_SYMBOL_GPL(usb_serial_generic_write_start); |
8e8dce06 DV |
180 | |
181 | /** | |
92ad2479 JH |
182 | * usb_serial_generic_write - generic write function |
183 | * @tty: tty for the port | |
184 | * @port: usb-serial port | |
185 | * @buf: data to write | |
186 | * @count: number of bytes to write | |
8e8dce06 | 187 | * |
92ad2479 JH |
188 | * Return: The number of characters buffered, which may be anything from |
189 | * zero to @count, or a negative errno value. | |
8e8dce06 | 190 | */ |
95da310e AC |
191 | int usb_serial_generic_write(struct tty_struct *tty, |
192 | struct usb_serial_port *port, const unsigned char *buf, int count) | |
1da177e4 | 193 | { |
1da177e4 | 194 | int result; |
1da177e4 | 195 | |
eb8878a8 JH |
196 | if (!port->bulk_out_size) |
197 | return -ENODEV; | |
198 | ||
1a1405e2 | 199 | if (!count) |
ae64387a | 200 | return 0; |
1da177e4 | 201 | |
119eecc8 | 202 | count = kfifo_in_locked(&port->write_fifo, buf, count, &port->lock); |
043e3f83 | 203 | result = usb_serial_generic_write_start(port, GFP_ATOMIC); |
c23e5fc1 JH |
204 | if (result) |
205 | return result; | |
1da177e4 | 206 | |
c23e5fc1 | 207 | return count; |
1da177e4 | 208 | } |
98fcb5f7 | 209 | EXPORT_SYMBOL_GPL(usb_serial_generic_write); |
1da177e4 | 210 | |
ae64387a | 211 | int usb_serial_generic_write_room(struct tty_struct *tty) |
1da177e4 | 212 | { |
95da310e | 213 | struct usb_serial_port *port = tty->driver_data; |
715b1dc0 | 214 | unsigned long flags; |
25d514ca | 215 | int room; |
1da177e4 | 216 | |
eb8878a8 JH |
217 | if (!port->bulk_out_size) |
218 | return 0; | |
219 | ||
715b1dc0 | 220 | spin_lock_irqsave(&port->lock, flags); |
c23e5fc1 | 221 | room = kfifo_avail(&port->write_fifo); |
715b1dc0 | 222 | spin_unlock_irqrestore(&port->lock, flags); |
1da177e4 | 223 | |
689c2781 | 224 | dev_dbg(&port->dev, "%s - returns %d\n", __func__, room); |
a5b6f60c | 225 | return room; |
1da177e4 LT |
226 | } |
227 | ||
95da310e | 228 | int usb_serial_generic_chars_in_buffer(struct tty_struct *tty) |
1da177e4 | 229 | { |
95da310e | 230 | struct usb_serial_port *port = tty->driver_data; |
715b1dc0 | 231 | unsigned long flags; |
eb8878a8 | 232 | int chars; |
1da177e4 | 233 | |
eb8878a8 JH |
234 | if (!port->bulk_out_size) |
235 | return 0; | |
236 | ||
25719e6b | 237 | spin_lock_irqsave(&port->lock, flags); |
c23e5fc1 | 238 | chars = kfifo_len(&port->write_fifo) + port->tx_bytes; |
25719e6b | 239 | spin_unlock_irqrestore(&port->lock, flags); |
1da177e4 | 240 | |
689c2781 | 241 | dev_dbg(&port->dev, "%s - returns %d\n", __func__, chars); |
95da310e | 242 | return chars; |
1da177e4 | 243 | } |
428d9988 | 244 | EXPORT_SYMBOL_GPL(usb_serial_generic_chars_in_buffer); |
1da177e4 | 245 | |
dcf01050 JH |
246 | void usb_serial_generic_wait_until_sent(struct tty_struct *tty, long timeout) |
247 | { | |
248 | struct usb_serial_port *port = tty->driver_data; | |
249 | unsigned int bps; | |
250 | unsigned long period; | |
251 | unsigned long expire; | |
252 | ||
253 | bps = tty_get_baud_rate(tty); | |
254 | if (!bps) | |
255 | bps = 9600; /* B0 */ | |
256 | /* | |
257 | * Use a poll-period of roughly the time it takes to send one | |
258 | * character or at least one jiffy. | |
259 | */ | |
260 | period = max_t(unsigned long, (10 * HZ / bps), 1); | |
f528bf4f JH |
261 | if (timeout) |
262 | period = min_t(unsigned long, period, timeout); | |
dcf01050 JH |
263 | |
264 | dev_dbg(&port->dev, "%s - timeout = %u ms, period = %u ms\n", | |
265 | __func__, jiffies_to_msecs(timeout), | |
266 | jiffies_to_msecs(period)); | |
267 | expire = jiffies + timeout; | |
268 | while (!port->serial->type->tx_empty(port)) { | |
269 | schedule_timeout_interruptible(period); | |
270 | if (signal_pending(current)) | |
271 | break; | |
f528bf4f | 272 | if (timeout && time_after(jiffies, expire)) |
dcf01050 JH |
273 | break; |
274 | } | |
275 | } | |
276 | EXPORT_SYMBOL_GPL(usb_serial_generic_wait_until_sent); | |
277 | ||
d83b4053 JH |
278 | static int usb_serial_generic_submit_read_urb(struct usb_serial_port *port, |
279 | int index, gfp_t mem_flags) | |
280 | { | |
281 | int res; | |
282 | ||
283 | if (!test_and_clear_bit(index, &port->read_urbs_free)) | |
284 | return 0; | |
285 | ||
49bd196d | 286 | dev_dbg(&port->dev, "%s - urb %d\n", __func__, index); |
d83b4053 JH |
287 | |
288 | res = usb_submit_urb(port->read_urbs[index], mem_flags); | |
289 | if (res) { | |
04f9c6e6 | 290 | if (res != -EPERM && res != -ENODEV) { |
d83b4053 JH |
291 | dev_err(&port->dev, |
292 | "%s - usb_submit_urb failed: %d\n", | |
293 | __func__, res); | |
294 | } | |
295 | set_bit(index, &port->read_urbs_free); | |
296 | return res; | |
297 | } | |
298 | ||
299 | return 0; | |
300 | } | |
301 | ||
302 | int usb_serial_generic_submit_read_urbs(struct usb_serial_port *port, | |
41bd72f9 | 303 | gfp_t mem_flags) |
1da177e4 | 304 | { |
d83b4053 JH |
305 | int res; |
306 | int i; | |
1da177e4 | 307 | |
d83b4053 JH |
308 | for (i = 0; i < ARRAY_SIZE(port->read_urbs); ++i) { |
309 | res = usb_serial_generic_submit_read_urb(port, i, mem_flags); | |
310 | if (res) | |
311 | goto err; | |
0ae14743 | 312 | } |
d83b4053 JH |
313 | |
314 | return 0; | |
315 | err: | |
316 | for (; i >= 0; --i) | |
317 | usb_kill_urb(port->read_urbs[i]); | |
318 | ||
319 | return res; | |
1da177e4 | 320 | } |
d83b4053 | 321 | EXPORT_SYMBOL_GPL(usb_serial_generic_submit_read_urbs); |
253ca923 | 322 | |
23154320 | 323 | void usb_serial_generic_process_read_urb(struct urb *urb) |
1abdeeb1 | 324 | { |
0f3d5bae | 325 | struct usb_serial_port *port = urb->context; |
98fcb5f7 JW |
326 | char *ch = (char *)urb->transfer_buffer; |
327 | int i; | |
328 | ||
56a1df46 JH |
329 | if (!urb->actual_length) |
330 | return; | |
92ad2479 JH |
331 | /* |
332 | * The per character mucking around with sysrq path it too slow for | |
333 | * stuff like 3G modems, so shortcircuit it in the 99.9999999% of | |
334 | * cases where the USB serial is not a console anyway. | |
335 | */ | |
ca0400d2 | 336 | if (!port->port.console || !port->sysrq) { |
05c7cd39 | 337 | tty_insert_flip_string(&port->port, ch, urb->actual_length); |
ca0400d2 | 338 | } else { |
4cd1de0a | 339 | for (i = 0; i < urb->actual_length; i++, ch++) { |
6ee9f4b4 | 340 | if (!usb_serial_handle_sysrq_char(port, *ch)) |
92a19f9c | 341 | tty_insert_flip_char(&port->port, *ch, TTY_NORMAL); |
4cd1de0a | 342 | } |
1abdeeb1 | 343 | } |
2e124b4a | 344 | tty_flip_buffer_push(&port->port); |
1abdeeb1 | 345 | } |
23154320 | 346 | EXPORT_SYMBOL_GPL(usb_serial_generic_process_read_urb); |
1abdeeb1 | 347 | |
95da310e | 348 | void usb_serial_generic_read_bulk_callback(struct urb *urb) |
253ca923 | 349 | { |
cdc97792 | 350 | struct usb_serial_port *port = urb->context; |
253ca923 | 351 | unsigned char *data = urb->transfer_buffer; |
bfaeafcf | 352 | unsigned long flags; |
d83b4053 | 353 | int i; |
253ca923 | 354 | |
d83b4053 JH |
355 | for (i = 0; i < ARRAY_SIZE(port->read_urbs); ++i) { |
356 | if (urb == port->read_urbs[i]) | |
357 | break; | |
358 | } | |
359 | set_bit(i, &port->read_urbs_free); | |
253ca923 | 360 | |
49bd196d JH |
361 | dev_dbg(&port->dev, "%s - urb %d, len %d\n", __func__, i, |
362 | urb->actual_length); | |
fc11efe2 JH |
363 | switch (urb->status) { |
364 | case 0: | |
365 | break; | |
366 | case -ENOENT: | |
367 | case -ECONNRESET: | |
368 | case -ESHUTDOWN: | |
369 | dev_dbg(&port->dev, "%s - urb stopped: %d\n", | |
370 | __func__, urb->status); | |
371 | return; | |
372 | case -EPIPE: | |
373 | dev_err(&port->dev, "%s - urb stopped: %d\n", | |
374 | __func__, urb->status); | |
253ca923 | 375 | return; |
fc11efe2 | 376 | default: |
aa8e2212 | 377 | dev_dbg(&port->dev, "%s - nonzero urb status: %d\n", |
fc11efe2 JH |
378 | __func__, urb->status); |
379 | goto resubmit; | |
253ca923 JR |
380 | } |
381 | ||
59d33f2f | 382 | usb_serial_debug_data(&port->dev, __func__, urb->actual_length, data); |
23154320 | 383 | port->serial->type->process_read_urb(urb); |
253ca923 | 384 | |
fc11efe2 | 385 | resubmit: |
253ca923 | 386 | /* Throttle the device if requested by tty */ |
bfaeafcf | 387 | spin_lock_irqsave(&port->lock, flags); |
ae64387a AC |
388 | port->throttled = port->throttle_req; |
389 | if (!port->throttled) { | |
b507cc97 | 390 | spin_unlock_irqrestore(&port->lock, flags); |
d83b4053 | 391 | usb_serial_generic_submit_read_urb(port, i, GFP_ATOMIC); |
ca0400d2 | 392 | } else { |
b507cc97 | 393 | spin_unlock_irqrestore(&port->lock, flags); |
ca0400d2 | 394 | } |
253ca923 | 395 | } |
166ffccf | 396 | EXPORT_SYMBOL_GPL(usb_serial_generic_read_bulk_callback); |
1da177e4 | 397 | |
95da310e | 398 | void usb_serial_generic_write_bulk_callback(struct urb *urb) |
1da177e4 | 399 | { |
715b1dc0 | 400 | unsigned long flags; |
cdc97792 | 401 | struct usb_serial_port *port = urb->context; |
27c7acf2 | 402 | int i; |
1da177e4 | 403 | |
ca0400d2 | 404 | for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i) { |
c23e5fc1 JH |
405 | if (port->write_urbs[i] == urb) |
406 | break; | |
ca0400d2 | 407 | } |
c23e5fc1 JH |
408 | spin_lock_irqsave(&port->lock, flags); |
409 | port->tx_bytes -= urb->transfer_buffer_length; | |
410 | set_bit(i, &port->write_urbs_free); | |
411 | spin_unlock_irqrestore(&port->lock, flags); | |
412 | ||
bd58c7bd JH |
413 | switch (urb->status) { |
414 | case 0: | |
415 | break; | |
416 | case -ENOENT: | |
417 | case -ECONNRESET: | |
418 | case -ESHUTDOWN: | |
419 | dev_dbg(&port->dev, "%s - urb stopped: %d\n", | |
420 | __func__, urb->status); | |
421 | return; | |
422 | case -EPIPE: | |
423 | dev_err_console(port, "%s - urb stopped: %d\n", | |
424 | __func__, urb->status); | |
425 | return; | |
426 | default: | |
427 | dev_err_console(port, "%s - nonzero urb status: %d\n", | |
428 | __func__, urb->status); | |
429 | goto resubmit; | |
1da177e4 | 430 | } |
8e8dce06 | 431 | |
bd58c7bd JH |
432 | resubmit: |
433 | usb_serial_generic_write_start(port, GFP_ATOMIC); | |
cf2c7481 | 434 | usb_serial_port_softint(port); |
1da177e4 | 435 | } |
bb833986 | 436 | EXPORT_SYMBOL_GPL(usb_serial_generic_write_bulk_callback); |
1da177e4 | 437 | |
95da310e | 438 | void usb_serial_generic_throttle(struct tty_struct *tty) |
253ca923 | 439 | { |
95da310e | 440 | struct usb_serial_port *port = tty->driver_data; |
253ca923 JR |
441 | unsigned long flags; |
442 | ||
253ca923 JR |
443 | spin_lock_irqsave(&port->lock, flags); |
444 | port->throttle_req = 1; | |
445 | spin_unlock_irqrestore(&port->lock, flags); | |
446 | } | |
f1e949ac | 447 | EXPORT_SYMBOL_GPL(usb_serial_generic_throttle); |
253ca923 | 448 | |
95da310e | 449 | void usb_serial_generic_unthrottle(struct tty_struct *tty) |
253ca923 | 450 | { |
95da310e | 451 | struct usb_serial_port *port = tty->driver_data; |
253ca923 | 452 | int was_throttled; |
253ca923 | 453 | |
0f3d5bae | 454 | spin_lock_irq(&port->lock); |
253ca923 JR |
455 | was_throttled = port->throttled; |
456 | port->throttled = port->throttle_req = 0; | |
0f3d5bae | 457 | spin_unlock_irq(&port->lock); |
253ca923 | 458 | |
0f3d5bae | 459 | if (was_throttled) |
d83b4053 | 460 | usb_serial_generic_submit_read_urbs(port, GFP_KERNEL); |
253ca923 | 461 | } |
f1e949ac | 462 | EXPORT_SYMBOL_GPL(usb_serial_generic_unthrottle); |
253ca923 | 463 | |
980373b7 JH |
464 | static bool usb_serial_generic_msr_changed(struct tty_struct *tty, |
465 | unsigned long arg, struct async_icount *cprev) | |
466 | { | |
467 | struct usb_serial_port *port = tty->driver_data; | |
468 | struct async_icount cnow; | |
469 | unsigned long flags; | |
470 | bool ret; | |
471 | ||
472 | /* | |
473 | * Use tty-port initialised flag to detect all hangups including the | |
474 | * one generated at USB-device disconnect. | |
980373b7 | 475 | */ |
980373b7 JH |
476 | if (!test_bit(ASYNCB_INITIALIZED, &port->port.flags)) |
477 | return true; | |
478 | ||
479 | spin_lock_irqsave(&port->lock, flags); | |
480 | cnow = port->icount; /* atomic copy*/ | |
481 | spin_unlock_irqrestore(&port->lock, flags); | |
482 | ||
483 | ret = ((arg & TIOCM_RNG) && (cnow.rng != cprev->rng)) || | |
484 | ((arg & TIOCM_DSR) && (cnow.dsr != cprev->dsr)) || | |
485 | ((arg & TIOCM_CD) && (cnow.dcd != cprev->dcd)) || | |
486 | ((arg & TIOCM_CTS) && (cnow.cts != cprev->cts)); | |
487 | ||
488 | *cprev = cnow; | |
489 | ||
490 | return ret; | |
491 | } | |
492 | ||
493 | int usb_serial_generic_tiocmiwait(struct tty_struct *tty, unsigned long arg) | |
494 | { | |
495 | struct usb_serial_port *port = tty->driver_data; | |
496 | struct async_icount cnow; | |
497 | unsigned long flags; | |
498 | int ret; | |
499 | ||
500 | spin_lock_irqsave(&port->lock, flags); | |
501 | cnow = port->icount; /* atomic copy */ | |
502 | spin_unlock_irqrestore(&port->lock, flags); | |
503 | ||
504 | ret = wait_event_interruptible(port->port.delta_msr_wait, | |
505 | usb_serial_generic_msr_changed(tty, arg, &cnow)); | |
91c4211c JH |
506 | if (!ret && !test_bit(ASYNCB_INITIALIZED, &port->port.flags)) |
507 | ret = -EIO; | |
980373b7 JH |
508 | |
509 | return ret; | |
510 | } | |
511 | EXPORT_SYMBOL_GPL(usb_serial_generic_tiocmiwait); | |
512 | ||
befefcda JH |
513 | int usb_serial_generic_get_icount(struct tty_struct *tty, |
514 | struct serial_icounter_struct *icount) | |
515 | { | |
516 | struct usb_serial_port *port = tty->driver_data; | |
517 | struct async_icount cnow; | |
518 | unsigned long flags; | |
519 | ||
520 | spin_lock_irqsave(&port->lock, flags); | |
521 | cnow = port->icount; /* atomic copy */ | |
522 | spin_unlock_irqrestore(&port->lock, flags); | |
523 | ||
524 | icount->cts = cnow.cts; | |
525 | icount->dsr = cnow.dsr; | |
526 | icount->rng = cnow.rng; | |
527 | icount->dcd = cnow.dcd; | |
528 | icount->tx = cnow.tx; | |
529 | icount->rx = cnow.rx; | |
530 | icount->frame = cnow.frame; | |
531 | icount->parity = cnow.parity; | |
532 | icount->overrun = cnow.overrun; | |
533 | icount->brk = cnow.brk; | |
534 | icount->buf_overrun = cnow.buf_overrun; | |
535 | ||
536 | return 0; | |
537 | } | |
538 | EXPORT_SYMBOL_GPL(usb_serial_generic_get_icount); | |
539 | ||
7f0ae3a8 | 540 | #ifdef CONFIG_MAGIC_SYSRQ |
6ee9f4b4 | 541 | int usb_serial_handle_sysrq_char(struct usb_serial_port *port, unsigned int ch) |
98fcb5f7 | 542 | { |
bd5afa9e | 543 | if (port->sysrq && port->port.console) { |
98fcb5f7 | 544 | if (ch && time_before(jiffies, port->sysrq)) { |
f335397d | 545 | handle_sysrq(ch); |
98fcb5f7 JW |
546 | port->sysrq = 0; |
547 | return 1; | |
548 | } | |
549 | port->sysrq = 0; | |
550 | } | |
551 | return 0; | |
552 | } | |
7f0ae3a8 | 553 | #else |
6ee9f4b4 | 554 | int usb_serial_handle_sysrq_char(struct usb_serial_port *port, unsigned int ch) |
7f0ae3a8 RD |
555 | { |
556 | return 0; | |
557 | } | |
558 | #endif | |
98fcb5f7 JW |
559 | EXPORT_SYMBOL_GPL(usb_serial_handle_sysrq_char); |
560 | ||
561 | int usb_serial_handle_break(struct usb_serial_port *port) | |
562 | { | |
563 | if (!port->sysrq) { | |
564 | port->sysrq = jiffies + HZ*5; | |
565 | return 1; | |
566 | } | |
567 | port->sysrq = 0; | |
568 | return 0; | |
569 | } | |
570 | EXPORT_SYMBOL_GPL(usb_serial_handle_break); | |
571 | ||
d14fc1a7 | 572 | /** |
92ad2479 JH |
573 | * usb_serial_handle_dcd_change - handle a change of carrier detect state |
574 | * @port: usb-serial port | |
575 | * @tty: tty for the port | |
576 | * @status: new carrier detect status, nonzero if active | |
d14fc1a7 LP |
577 | */ |
578 | void usb_serial_handle_dcd_change(struct usb_serial_port *usb_port, | |
579 | struct tty_struct *tty, unsigned int status) | |
580 | { | |
581 | struct tty_port *port = &usb_port->port; | |
582 | ||
49bd196d | 583 | dev_dbg(&usb_port->dev, "%s - status %d\n", __func__, status); |
d14fc1a7 | 584 | |
833efc0e PC |
585 | if (tty) { |
586 | struct tty_ldisc *ld = tty_ldisc_ref(tty); | |
587 | ||
588 | if (ld) { | |
589 | if (ld->ops->dcd_change) | |
590 | ld->ops->dcd_change(tty, status); | |
591 | tty_ldisc_deref(ld); | |
592 | } | |
593 | } | |
594 | ||
d14fc1a7 LP |
595 | if (status) |
596 | wake_up_interruptible(&port->open_wait); | |
597 | else if (tty && !C_CLOCAL(tty)) | |
598 | tty_hangup(tty); | |
599 | } | |
600 | EXPORT_SYMBOL_GPL(usb_serial_handle_dcd_change); | |
601 | ||
8e8dce06 DV |
602 | int usb_serial_generic_resume(struct usb_serial *serial) |
603 | { | |
604 | struct usb_serial_port *port; | |
605 | int i, c = 0, r; | |
606 | ||
607 | for (i = 0; i < serial->num_ports; i++) { | |
608 | port = serial->port[i]; | |
1f87158e | 609 | if (!test_bit(ASYNCB_INITIALIZED, &port->port.flags)) |
8e8dce06 DV |
610 | continue; |
611 | ||
d83b4053 JH |
612 | if (port->bulk_in_size) { |
613 | r = usb_serial_generic_submit_read_urbs(port, | |
614 | GFP_NOIO); | |
8e8dce06 DV |
615 | if (r < 0) |
616 | c++; | |
617 | } | |
618 | ||
27c7acf2 | 619 | if (port->bulk_out_size) { |
818f6036 | 620 | r = usb_serial_generic_write_start(port, GFP_NOIO); |
8e8dce06 DV |
621 | if (r < 0) |
622 | c++; | |
623 | } | |
624 | } | |
625 | ||
626 | return c ? -EIO : 0; | |
627 | } | |
628 | EXPORT_SYMBOL_GPL(usb_serial_generic_resume); |