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 */
oz_remember_urb(struct urb * urb)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 */
oz_forget_urb(struct urb * urb)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
54