Contiki 2.5
memb.c
Go to the documentation of this file.
1 /*
2  * Copyright (c) 2004, Swedish Institute of Computer Science.
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  * notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  * notice, this list of conditions and the following disclaimer in the
12  * documentation and/or other materials provided with the distribution.
13  * 3. Neither the name of the Institute nor the names of its contributors
14  * may be used to endorse or promote products derived from this software
15  * without specific prior written permission.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND
18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20  * ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE
21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27  * SUCH DAMAGE.
28  *
29  * This file is part of the Contiki operating system.
30  *
31  * Author: Adam Dunkels <adam@sics.se>
32  *
33  * $Id: memb.c,v 1.4 2009/04/06 21:18:03 adamdunkels Exp $
34  */
35 
36 /**
37  * \addtogroup memb
38  * @{
39  */
40 
41  /**
42  * \file
43  * Memory block allocation routines.
44  * \author Adam Dunkels <adam@sics.se>
45  */
46 #include <string.h>
47 
48 #include "contiki.h"
49 #include "lib/memb.h"
50 
51 /*---------------------------------------------------------------------------*/
52 void
53 memb_init(struct memb *m)
54 {
55  memset(m->count, 0, m->num);
56  memset(m->mem, 0, m->size * m->num);
57 }
58 /*---------------------------------------------------------------------------*/
59 void *
60 memb_alloc(struct memb *m)
61 {
62  int i;
63 
64  for(i = 0; i < m->num; ++i) {
65  if(m->count[i] == 0) {
66  /* If this block was unused, we increase the reference count to
67  indicate that it now is used and return a pointer to the
68  memory block. */
69  ++(m->count[i]);
70  return (void *)((char *)m->mem + (i * m->size));
71  }
72  }
73 
74  /* No free block was found, so we return NULL to indicate failure to
75  allocate block. */
76  return NULL;
77 }
78 /*---------------------------------------------------------------------------*/
79 char
80 memb_free(struct memb *m, void *ptr)
81 {
82  int i;
83  char *ptr2;
84 
85  /* Walk through the list of blocks and try to find the block to
86  which the pointer "ptr" points to. */
87  ptr2 = (char *)m->mem;
88  for(i = 0; i < m->num; ++i) {
89 
90  if(ptr2 == (char *)ptr) {
91  /* We've found to block to which "ptr" points so we decrease the
92  reference count and return the new value of it. */
93  if(m->count[i] > 0) {
94  /* Make sure that we don't deallocate free memory. */
95  --(m->count[i]);
96  }
97  return m->count[i];
98  }
99  ptr2 += m->size;
100  }
101  return -1;
102 }
103 /*---------------------------------------------------------------------------*/
104 int
105 memb_inmemb(struct memb *m, void *ptr)
106 {
107  return (char *)ptr >= (char *)m->mem &&
108  (char *)ptr < (char *)m->mem + (m->num * m->size);
109 }
110 /*---------------------------------------------------------------------------*/
111 
112 /** @} */