drivers/staging/ozwpan/ozurbparanoia.c

   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 "ozdbg.h"
   8
   9 #ifdef WANT_URB_PARANOIA
  10
  11 #include "ozurbparanoia.h"
  12
  13 /*-----------------------------------------------------------------------------
  14  */
  15 #define OZ_MAX_URBS     1000
  16 struct urb *g_urb_memory[OZ_MAX_URBS];
  17 int g_nb_urbs;
  18 DEFINE_SPINLOCK(g_urb_mem_lock);
  19 /*-----------------------------------------------------------------------------
  20  */
  21 void oz_remember_urb(struct urb *urb)
  22 {
  23         unsigned long irq_state;
  24         spin_lock_irqsave(&g_urb_mem_lock, irq_state);
  25         if (g_nb_urbs < OZ_MAX_URBS) {
  26                 g_urb_memory[g_nb_urbs++] = urb;
  27                 oz_dbg(ON, "%lu: urb up = %d %p\n", jiffies, g_nb_urbs, urb);
  28         } else {
  29                 oz_dbg(ON, "ERROR urb buffer full\n");
  30         }
  31         spin_unlock_irqrestore(&g_urb_mem_lock, irq_state);
  32 }
  33 /*------------------------------------------------------------------------------
  34  */
  35 int oz_forget_urb(struct urb *urb)
  36 {
  37         unsigned long irq_state;
  38         int i;
  39         int rc = -1;
  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 *));
  47                         oz_dbg(ON, "%lu: urb down = %d %p\n",
  48                                jiffies, g_nb_urbs, urb);
  49                 }
  50         }
  51         spin_unlock_irqrestore(&g_urb_mem_lock, irq_state);
  52         return rc;
  53 }
  54 #endif /* #ifdef WANT_URB_PARANOIA */
  55