Output/pjrcUSB/arm/usb_mem.c

   1 /* Teensyduino Core Library
   2  * http://www.pjrc.com/teensy/
   3  * Copyright (c) 2013 PJRC.COM, LLC.
   4  *
   5  * Permission is hereby granted, free of charge, to any person obtaining
   6  * a copy of this software and associated documentation files (the
   7  * "Software"), to deal in the Software without restriction, including
   8  * without limitation the rights to use, copy, modify, merge, publish,
   9  * distribute, sublicense, and/or sell copies of the Software, and to
  10  * permit persons to whom the Software is furnished to do so, subject to
  11  * the following conditions:
  12  *
  13  * 1. The above copyright notice and this permission notice shall be
  14  * included in all copies or substantial portions of the Software.
  15  *
  16  * 2. If the Software is incorporated into a build system that allows
  17  * selection among a list of target devices, then similar target
  18  * devices manufactured by PJRC.COM must be included in the list of
  19  * target devices and selectable in the same manner.
  20  *
  21  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  22  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  23  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  24  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  25  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  26  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  27  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  28  * SOFTWARE.
  29  */
  30
  31 #include <Lib/OutputLib.h>
  32 #include "usb_dev.h"
  33 #include "usb_mem.h"
  34
  35 __attribute__ ((section(".usbbuffers"), used))
  36 unsigned char usb_buffer_memory[NUM_USB_BUFFERS * sizeof(usb_packet_t)];
  37
  38 static uint32_t usb_buffer_available = 0xFFFFFFFF;
  39
  40 // use bitmask and CLZ instruction to implement fast free list
  41 // http://www.archivum.info/gnu.gcc.help/2006-08/00148/Re-GCC-Inline-Assembly.html
  42 // http://gcc.gnu.org/ml/gcc/2012-06/msg00015.html
  43 // __builtin_clz()
  44
  45 usb_packet_t * usb_malloc(void)
  46 {
  47         unsigned int n, avail;
  48         uint8_t *p;
  49
  50         __disable_irq();
  51         avail = usb_buffer_available;
  52         n = __builtin_clz(avail); // clz = count leading zeros
  53         if (n >= NUM_USB_BUFFERS) {
  54                 __enable_irq();
  55                 return NULL;
  56         }
  57         //serial_print("malloc:");
  58         //serial_phex(n);
  59         //serial_print("\n");
  60
  61         usb_buffer_available = avail & ~(0x80000000 >> n);
  62         __enable_irq();
  63         p = usb_buffer_memory + (n * sizeof(usb_packet_t));
  64         //serial_print("malloc:");
  65         //serial_phex32((int)p);
  66         //serial_print("\n");
  67         *(uint32_t *)p = 0;
  68         *(uint32_t *)(p + 4) = 0;
  69         return (usb_packet_t *)p;
  70 }
  71
  72 // for the receive endpoints to request memory
  73 extern uint8_t usb_rx_memory_needed;
  74 extern void usb_rx_memory(usb_packet_t *packet);
  75
  76 void usb_free(usb_packet_t *p)
  77 {
  78         unsigned int n, mask;
  79
  80         //serial_print("free:");
  81         n = ((uint8_t *)p - usb_buffer_memory) / sizeof(usb_packet_t);
  82         if (n >= NUM_USB_BUFFERS) return;
  83         //serial_phex(n);
  84         //serial_print("\n");
  85
  86         // if any endpoints are starving for memory to receive
  87         // packets, give this memory to them immediately!
  88         if (usb_rx_memory_needed && usb_configuration) {
  89                 //serial_print("give to rx:");
  90                 //serial_phex32((int)p);
  91                 //serial_print("\n");
  92                 usb_rx_memory(p);
  93                 return;
  94         }
  95
  96         mask = (0x80000000 >> n);
  97         __disable_irq();
  98         usb_buffer_available |= mask;
  99         __enable_irq();
 100
 101         //serial_print("free:");
 102         //serial_phex32((int)p);
 103         //serial_print("\n");
 104 }
 105