123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221 |
- /****************************************************************************
- * net/bluetooth/bluetooth_container.c
- *
- * Copyright (C) 2018 Gregory Nutt. All rights reserved.
- * Author: Gregory Nutt <gnutt@nuttx.org>
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- *
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in
- * the documentation and/or other materials provided with the
- * distribution.
- * 3. Neither the name NuttX nor the names of its contributors may be
- * used to endorse or promote products derived from this software
- * without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
- * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
- * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
- * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
- * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
- * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
- * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
- * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
- * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
- * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
- * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
- * POSSIBILITY OF SUCH DAMAGE.
- *
- ****************************************************************************/
- /****************************************************************************
- * Included Files
- ****************************************************************************/
- #include <nuttx/config.h>
- #include <stdint.h>
- #include <stdbool.h>
- #include <string.h>
- #include <semaphore.h>
- #include <assert.h>
- #include <errno.h>
- #include <nuttx/kmalloc.h>
- #include <nuttx/mm/iob.h>
- #include "bluetooth/bluetooth.h"
- /****************************************************************************
- * Private Data
- ****************************************************************************/
- /* The g_free_container is a list of IOB container structures that are
- * available for general use. The number of messages in this list is a
- * system configuration item.
- *
- * Mutually exclusive access to this list is managed via the network lock:
- * i.e., the network must be locked beffore accessing this free list.
- */
- static FAR struct bluetooth_container_s *g_free_container;
- /* Pool of pre-allocated meta-data stuctures */
- static struct bluetooth_container_s
- g_container_pool[CONFIG_NET_BLUETOOTH_NCONTAINERS];
- /****************************************************************************
- * Public Functions
- ****************************************************************************/
- /****************************************************************************
- * Name: bluetooth_container_initialize
- *
- * Description:
- * This function initializes the container allocator. This function must
- * be called early in the initialization sequence before any socket
- * activity.
- *
- * Input Parameters:
- * None
- *
- * Returned Value:
- * None
- *
- * Assumptions:
- * Called early in the initialization sequence
- *
- ****************************************************************************/
- void bluetooth_container_initialize(void)
- {
- FAR struct bluetooth_container_s *container;
- int i;
- /* Initialize g_free_container, the list of meta-data structures that
- * are available for allocation.
- */
- g_free_container = NULL;
- for (i = 0, container = g_container_pool;
- i < CONFIG_NET_BLUETOOTH_NCONTAINERS;
- i++, container++)
- {
- /* Add the next meta data structure from the pool to the list of
- * general structures.
- */
- container->bn_flink = g_free_container;
- g_free_container = container;
- }
- }
- /****************************************************************************
- * Name: bluetooth_container_allocate
- *
- * Description:
- * The bluetooth_container_allocate function will get a free continer
- * for use by the recvfrom() logic.
- *
- * This function will first attempt to allocate from the g_free_container
- * list. If that the list is empty, then the meta-data structure will be
- * allocated from the dynamic memory pool.
- *
- * Input Parameters:
- * None
- *
- * Returned Value:
- * A reference to the allocated container structure. All user fields in this
- * structure have been zeroed. On a failure to allocate, NULL is
- * returned.
- *
- * Assumptions:
- * The caller has locked the network.
- *
- ****************************************************************************/
- FAR struct bluetooth_container_s *bluetooth_container_allocate(void)
- {
- FAR struct bluetooth_container_s *container;
- uint8_t pool;
- /* Try the free list first */
- net_lock();
- if (g_free_container != NULL)
- {
- container = g_free_container;
- g_free_container = container->bn_flink;
- pool = BLUETOOTH_POOL_PREALLOCATED;
- net_unlock();
- }
- else
- {
- net_unlock();
- container = (FAR struct bluetooth_container_s *)
- kmm_malloc((sizeof (struct bluetooth_container_s)));
- pool = BLUETOOTH_POOL_DYNAMIC;
- }
- /* We have successfully allocated memory from some source? */
- if (container != NULL)
- {
- /* Zero and tag the allocated meta-data structure. */
- memset(container, 0, sizeof(struct bluetooth_container_s));
- container->bn_pool = pool;
- }
- return container;
- }
- /****************************************************************************
- * Name: bluetooth_container_free
- *
- * Description:
- * The bluetooth_container_free function will return a container structure
- * to the free list of containers if it was a pre-allocated container
- * structure. If the container structure was allocated dynamically it will
- * be deallocated.
- *
- * Input Parameters:
- * container - container structure to free
- *
- * Returned Value:
- * None
- *
- * Assumptions:
- * The caller has locked the network.
- *
- ****************************************************************************/
- void bluetooth_container_free(FAR struct bluetooth_container_s *container)
- {
- /* If this is a pre-allocated meta-data structure, then just put it back
- * in the free list.
- */
- net_lock();
- if (container->bn_pool == BLUETOOTH_POOL_PREALLOCATED)
- {
- container->bn_flink = g_free_container;
- g_free_container = container;
- net_unlock();
- }
- else
- {
- DEBUGASSERT(container->bn_pool == BLUETOOTH_POOL_DYNAMIC);
- /* Otherwise, deallocate it. */
- net_unlock();
- sched_kfree(container);
- }
- }
|