| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 1 | /* ----------------------------------------------------------------------------- |
| 2 | * Copyright (c) 2011 Ozmo Inc |
| 3 | * Released under the GNU General Public License Version 2 (GPLv2). |
| 4 | * ----------------------------------------------------------------------------- |
| 5 | */ |
| 6 | #include <linux/usb.h> |
| Joe Perches | f724b58 | 2013-07-23 13:45:00 +0100 | [diff] [blame] | 7 | #include "ozdbg.h" |
| Joe Perches | 05f608f | 2013-07-23 13:45:01 +0100 | [diff] [blame] | 8 | |
| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 9 | #ifdef WANT_URB_PARANOIA |
| Joe Perches | 05f608f | 2013-07-23 13:45:01 +0100 | [diff] [blame] | 10 | |
| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 11 | #include "ozurbparanoia.h" |
| Joe Perches | 05f608f | 2013-07-23 13:45:01 +0100 | [diff] [blame] | 12 | |
| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 13 | #define OZ_MAX_URBS 1000 |
| 14 | struct urb *g_urb_memory[OZ_MAX_URBS]; |
| 15 | int g_nb_urbs; |
| 16 | DEFINE_SPINLOCK(g_urb_mem_lock); |
| Rupesh Gujare | 6e244a8 | 2013-08-13 18:24:22 +0100 | [diff] [blame] | 17 | |
| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 18 | void oz_remember_urb(struct urb *urb) |
| 19 | { |
| 20 | unsigned long irq_state; |
| Rupesh Gujare | 18f8191 | 2013-08-13 18:24:21 +0100 | [diff] [blame] | 21 | |
| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 22 | spin_lock_irqsave(&g_urb_mem_lock, irq_state); |
| 23 | if (g_nb_urbs < OZ_MAX_URBS) { |
| 24 | g_urb_memory[g_nb_urbs++] = urb; |
| Rupesh Gujare | 8fd0700 | 2013-07-30 13:31:50 +0100 | [diff] [blame] | 25 | oz_dbg(ON, "urb up = %d %p\n", g_nb_urbs, urb); |
| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 26 | } else { |
| Joe Perches | f724b58 | 2013-07-23 13:45:00 +0100 | [diff] [blame] | 27 | oz_dbg(ON, "ERROR urb buffer full\n"); |
| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 28 | } |
| 29 | spin_unlock_irqrestore(&g_urb_mem_lock, irq_state); |
| 30 | } |
| Rupesh Gujare | 6e244a8 | 2013-08-13 18:24:22 +0100 | [diff] [blame] | 31 | |
| Rupesh Gujare | 4e7fb82 | 2013-08-23 16:11:02 +0100 | [diff] [blame] | 32 | /* |
| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 33 | */ |
| 34 | int oz_forget_urb(struct urb *urb) |
| 35 | { |
| 36 | unsigned long irq_state; |
| 37 | int i; |
| 38 | int rc = -1; |
| Rupesh Gujare | 18f8191 | 2013-08-13 18:24:21 +0100 | [diff] [blame] | 39 | |
| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 40 | spin_lock_irqsave(&g_urb_mem_lock, irq_state); |
| 41 | for (i = 0; i < g_nb_urbs; i++) { |
| 42 | if (g_urb_memory[i] == urb) { |
| 43 | rc = 0; |
| 44 | if (--g_nb_urbs > i) |
| 45 | memcpy(&g_urb_memory[i], &g_urb_memory[i+1], |
| 46 | (g_nb_urbs - i) * sizeof(struct urb *)); |
| Rupesh Gujare | 8fd0700 | 2013-07-30 13:31:50 +0100 | [diff] [blame] | 47 | oz_dbg(ON, "urb down = %d %p\n", g_nb_urbs, urb); |
| Chris Kelly | 066b222 | 2012-02-20 21:12:35 +0000 | [diff] [blame] | 48 | } |
| 49 | } |
| 50 | spin_unlock_irqrestore(&g_urb_mem_lock, irq_state); |
| 51 | return rc; |
| 52 | } |
| 53 | #endif /* #ifdef WANT_URB_PARANOIA */ |
| 54 | |