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> |
| 7 | #include "ozconfig.h" |
| 8 | #ifdef WANT_URB_PARANOIA |
| 9 | #include "ozurbparanoia.h" |
| 10 | #include "oztrace.h" |
| 11 | /*----------------------------------------------------------------------------- |
| 12 | */ |
| 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); |
| 17 | /*----------------------------------------------------------------------------- |
| 18 | */ |
| 19 | void oz_remember_urb(struct urb *urb) |
| 20 | { |
| 21 | unsigned long irq_state; |
| 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; |
| 25 | oz_trace("%lu: urb up = %d %p\n", jiffies, g_nb_urbs, urb); |
| 26 | } else { |
| 27 | oz_trace("ERROR urb buffer full\n"); |
| 28 | } |
| 29 | spin_unlock_irqrestore(&g_urb_mem_lock, irq_state); |
| 30 | } |
| 31 | /*------------------------------------------------------------------------------ |
| 32 | */ |
| 33 | int oz_forget_urb(struct urb *urb) |
| 34 | { |
| 35 | unsigned long irq_state; |
| 36 | int i; |
| 37 | int rc = -1; |
| 38 | spin_lock_irqsave(&g_urb_mem_lock, irq_state); |
| 39 | for (i = 0; i < g_nb_urbs; i++) { |
| 40 | if (g_urb_memory[i] == urb) { |
| 41 | rc = 0; |
| 42 | if (--g_nb_urbs > i) |
| 43 | memcpy(&g_urb_memory[i], &g_urb_memory[i+1], |
| 44 | (g_nb_urbs - i) * sizeof(struct urb *)); |
| 45 | oz_trace("%lu: urb down = %d %p\n", |
| 46 | jiffies, g_nb_urbs, urb); |
| 47 | } |
| 48 | } |
| 49 | spin_unlock_irqrestore(&g_urb_mem_lock, irq_state); |
| 50 | return rc; |
| 51 | } |
| 52 | #endif /* #ifdef WANT_URB_PARANOIA */ |
| 53 | |