Junichi Katsu / Mbed 2 deprecated BLEControl

Dependencies:   FatFileSystem TB6612FNG2 mbed

Committer:
mbed_Cookbook_SE
Date:
Mon Nov 30 09:32:15 2015 +0000
Revision:
0:de03cbbcd0ff
??

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbed_Cookbook_SE 0:de03cbbcd0ff 1 /*
mbed_Cookbook_SE 0:de03cbbcd0ff 2 * Copyright (C) 2011 by Matthias Ringwald
mbed_Cookbook_SE 0:de03cbbcd0ff 3 *
mbed_Cookbook_SE 0:de03cbbcd0ff 4 * Redistribution and use in source and binary forms, with or without
mbed_Cookbook_SE 0:de03cbbcd0ff 5 * modification, are permitted provided that the following conditions
mbed_Cookbook_SE 0:de03cbbcd0ff 6 * are met:
mbed_Cookbook_SE 0:de03cbbcd0ff 7 *
mbed_Cookbook_SE 0:de03cbbcd0ff 8 * 1. Redistributions of source code must retain the above copyright
mbed_Cookbook_SE 0:de03cbbcd0ff 9 * notice, this list of conditions and the following disclaimer.
mbed_Cookbook_SE 0:de03cbbcd0ff 10 * 2. Redistributions in binary form must reproduce the above copyright
mbed_Cookbook_SE 0:de03cbbcd0ff 11 * notice, this list of conditions and the following disclaimer in the
mbed_Cookbook_SE 0:de03cbbcd0ff 12 * documentation and/or other materials provided with the distribution.
mbed_Cookbook_SE 0:de03cbbcd0ff 13 * 3. Neither the name of the copyright holders nor the names of
mbed_Cookbook_SE 0:de03cbbcd0ff 14 * contributors may be used to endorse or promote products derived
mbed_Cookbook_SE 0:de03cbbcd0ff 15 * from this software without specific prior written permission.
mbed_Cookbook_SE 0:de03cbbcd0ff 16 *
mbed_Cookbook_SE 0:de03cbbcd0ff 17 * THIS SOFTWARE IS PROVIDED BY MATTHIAS RINGWALD AND CONTRIBUTORS
mbed_Cookbook_SE 0:de03cbbcd0ff 18 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
mbed_Cookbook_SE 0:de03cbbcd0ff 19 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
mbed_Cookbook_SE 0:de03cbbcd0ff 20 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
mbed_Cookbook_SE 0:de03cbbcd0ff 21 * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
mbed_Cookbook_SE 0:de03cbbcd0ff 22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
mbed_Cookbook_SE 0:de03cbbcd0ff 23 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
mbed_Cookbook_SE 0:de03cbbcd0ff 24 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
mbed_Cookbook_SE 0:de03cbbcd0ff 25 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
mbed_Cookbook_SE 0:de03cbbcd0ff 26 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
mbed_Cookbook_SE 0:de03cbbcd0ff 27 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
mbed_Cookbook_SE 0:de03cbbcd0ff 28 * SUCH DAMAGE.
mbed_Cookbook_SE 0:de03cbbcd0ff 29 *
mbed_Cookbook_SE 0:de03cbbcd0ff 30 */
mbed_Cookbook_SE 0:de03cbbcd0ff 31
mbed_Cookbook_SE 0:de03cbbcd0ff 32 /*
mbed_Cookbook_SE 0:de03cbbcd0ff 33 * memory_pool.c
mbed_Cookbook_SE 0:de03cbbcd0ff 34 *
mbed_Cookbook_SE 0:de03cbbcd0ff 35 * Fixed-size block allocation
mbed_Cookbook_SE 0:de03cbbcd0ff 36 *
mbed_Cookbook_SE 0:de03cbbcd0ff 37 * Free blocks are kept in singly linked list
mbed_Cookbook_SE 0:de03cbbcd0ff 38 *
mbed_Cookbook_SE 0:de03cbbcd0ff 39 */
mbed_Cookbook_SE 0:de03cbbcd0ff 40
mbed_Cookbook_SE 0:de03cbbcd0ff 41 #include "btstack/memory_pool.h"
mbed_Cookbook_SE 0:de03cbbcd0ff 42 #include <stddef.h>
mbed_Cookbook_SE 0:de03cbbcd0ff 43
mbed_Cookbook_SE 0:de03cbbcd0ff 44 typedef struct node {
mbed_Cookbook_SE 0:de03cbbcd0ff 45 struct node * next;
mbed_Cookbook_SE 0:de03cbbcd0ff 46 } node_t;
mbed_Cookbook_SE 0:de03cbbcd0ff 47
mbed_Cookbook_SE 0:de03cbbcd0ff 48 void memory_pool_create(memory_pool_t *pool, void * storage, int count, int block_size){
mbed_Cookbook_SE 0:de03cbbcd0ff 49 node_t *free_blocks = (node_t*) pool;
mbed_Cookbook_SE 0:de03cbbcd0ff 50 char *mem_ptr = (char *) storage;
mbed_Cookbook_SE 0:de03cbbcd0ff 51 int i;
mbed_Cookbook_SE 0:de03cbbcd0ff 52
mbed_Cookbook_SE 0:de03cbbcd0ff 53 // create singly linked list of all available blocks
mbed_Cookbook_SE 0:de03cbbcd0ff 54 free_blocks->next = NULL;
mbed_Cookbook_SE 0:de03cbbcd0ff 55 for (i = 0 ; i < count ; i++){
mbed_Cookbook_SE 0:de03cbbcd0ff 56 memory_pool_free(pool, mem_ptr);
mbed_Cookbook_SE 0:de03cbbcd0ff 57 mem_ptr += block_size;
mbed_Cookbook_SE 0:de03cbbcd0ff 58 }
mbed_Cookbook_SE 0:de03cbbcd0ff 59 }
mbed_Cookbook_SE 0:de03cbbcd0ff 60
mbed_Cookbook_SE 0:de03cbbcd0ff 61 void * memory_pool_get(memory_pool_t *pool){
mbed_Cookbook_SE 0:de03cbbcd0ff 62 node_t *free_blocks = (node_t*) pool;
mbed_Cookbook_SE 0:de03cbbcd0ff 63
mbed_Cookbook_SE 0:de03cbbcd0ff 64 if (!free_blocks->next) return NULL;
mbed_Cookbook_SE 0:de03cbbcd0ff 65
mbed_Cookbook_SE 0:de03cbbcd0ff 66 // remove first
mbed_Cookbook_SE 0:de03cbbcd0ff 67 node_t *node = free_blocks->next;
mbed_Cookbook_SE 0:de03cbbcd0ff 68 free_blocks->next = node->next;
mbed_Cookbook_SE 0:de03cbbcd0ff 69
mbed_Cookbook_SE 0:de03cbbcd0ff 70 return (void*) node;
mbed_Cookbook_SE 0:de03cbbcd0ff 71 }
mbed_Cookbook_SE 0:de03cbbcd0ff 72
mbed_Cookbook_SE 0:de03cbbcd0ff 73 void memory_pool_free(memory_pool_t *pool, void * block){
mbed_Cookbook_SE 0:de03cbbcd0ff 74 node_t *free_blocks = (node_t*) pool;
mbed_Cookbook_SE 0:de03cbbcd0ff 75 node_t *node = (node_t*) block;
mbed_Cookbook_SE 0:de03cbbcd0ff 76 // add block as node to list
mbed_Cookbook_SE 0:de03cbbcd0ff 77 node->next = free_blocks->next;
mbed_Cookbook_SE 0:de03cbbcd0ff 78 free_blocks->next = node;
mbed_Cookbook_SE 0:de03cbbcd0ff 79 }