mmem.c

Go to the documentation of this file.

/*
 * Copyright (c) 2005, Swedish Institute of Computer Science
 * All rights reserved.
 *
 * 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 of the Institute 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 INSTITUTE 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 INSTITUTE 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.
 *
 * This file is part of the Contiki operating system.
 *
 * @(#)$Id: mmem.c,v 1.2 2006/12/22 17:14:06 barner Exp $
 */

/**
 * \addtogroup mmem
 * @{
 */

/**
 * \file
 *         Implementation of the managed memory allocator
 * \author
 *         Adam Dunkels <adam@sics.se>
 * 
 */


#include "mmem.h"
#include "list.h"
#include "contiki-conf.h"
#include <string.h>
#include "profiling.h"

#define DEBUG 0
#if DEBUG
#include <stdio.h>
#define PRINTF(...) printf(__VA_ARGS__)
#else
#define PRINTF(...)
#endif

#ifdef MMEM_CONF_SIZE
#define MMEM_SIZE MMEM_CONF_SIZE
#else
#define MMEM_SIZE 4096
#endif

#ifdef MMEM_CONF_ALIGNMENT
#define MMEM_ALIGNMENT MMEM_CONF_ALIGNMENT
#else
#define MMEM_ALIGNMENT 2
#endif

LIST(mmemlist);
unsigned int avail_memory;
static char memory[MMEM_SIZE];

/*---------------------------------------------------------------------------*/
/**
 * \brief      Allocate a managed memory block
 * \param m    A pointer to a struct mmem.
 * \param size The size of the requested memory block
 * \return     Non-zero if the memory could be allocated, zero if memory
 *             was not available.
 * \author     Adam Dunkels
 *
 *             This function allocates a chunk of managed memory. The
 *             memory allocated with this function must be deallocated
 *             using the mmem_free() function.
 *
 *             \note This function does NOT return a pointer to the
 *             allocated memory, but a pointer to a structure that
 *             contains information about the managed memory. The
 *             macro MMEM_PTR() is used to get a pointer to the
 *             allocated memory.
 *
 */
int
mmem_alloc(struct mmem *m, unsigned int size)
{
  /* Check if we have enough memory left for this allocation. */
  if((avail_memory < size) ) {
    PRINTF("MMEM: %u < %u\n",avail_memory,size);
    return 0;
  }
  if (avail_memory> MMEM_SIZE){
        PRINTF("MMEM: %u >  %u\n",avail_memory,MMEM_SIZE);
        return 0;
  }


  /* We had enough memory so we add this memory block to the end of
     the list of allocated memory blocks. */
  list_add(mmemlist, m);

  /* Set up the pointer so that it points to the first available byte
     in the memory block. */
  m->ptr = &memory[MMEM_SIZE - avail_memory];
  /* Remember the size of this memory block. */
  m->size = size;
  m->real_size = size;

  while( m->real_size % MMEM_ALIGNMENT != 0 ) {
          m->real_size ++;
  }

  /* Decrease the amount of available memory. */
  avail_memory -= m->real_size;
  /* Return non-zero to indicate that we were able to allocate
     memory. */
  return 1;
}
/*---------------------------------------------------------------------------*/
/**
 * \brief      Deallocate a managed memory block
 * \param m    A pointer to the managed memory block
 * \author     Adam Dunkels
 *
 *             This function deallocates a managed memory block that
 *             previously has been allocated with mmem_alloc().
 *
 */
void
mmem_free(struct mmem *m)
{
  if(m->real_size > MMEM_SIZE - avail_memory){
        PRINTF("MMEM: too much free %u\n", m->real_size);
        return;
  }
  struct mmem *n;
  if(m->next != NULL) {
    /* Compact the memory after the allocation that is to be removed
       by moving it downwards. */
    memmove(m->ptr, m->next->ptr,
            &memory[MMEM_SIZE - avail_memory] - (char *)m->next->ptr);
    
    /* Update all the memory pointers that points to memory that is
       after the allocation that is to be removed. */
    for(n = m->next; n != NULL; n = n->next) {
      n->ptr = (void *)((char *)n->ptr - m->real_size);
    }
  }

  avail_memory += m->real_size;
//  PRINTF("MMEM: free %u\n",avail_memory);

  /* Remove the memory block from the list. */
  list_remove(mmemlist, m);
}

/*---------------------------------------------------------------------------*/
/**
 * \brief      Change the size of allocated memory
 * \param mem  mmem chunk whose size should be changed
 * \param size Size to change the chunk to
 * \return     1 on success, 0 on failure
 * \author     Daniel Willmann
 *
 *             This function is the mmem equivalent of realloc(). If the size
 *             could not be changed the original chunk is preserved.
 */
int
mmem_realloc(struct mmem *mem, unsigned int size)
{
  int mysize = size;

  while( mysize % MMEM_ALIGNMENT != 0 ) {
          mysize ++;
  }

  int diff = (int)mysize - mem->real_size;

  /* Already the correct size */
  if (diff == 0)
    return 1;

  /* Check if request is to big */
  if (diff > 0 && diff > avail_memory) {
    PRINTF("MMEM: realloc failed (diff: %i, avail: %u\n", diff, avail_memory);
    return 0;
  }

  /* We need to do the same thing as in mmem_free */
  struct mmem *n;
  if (mem->next != NULL) {
    memmove((char *)mem->next->ptr+diff, (char *)mem->next->ptr,
                    &memory[MMEM_SIZE - avail_memory] - (char *)mem->next->ptr);

    /* Update all the memory pointers that points to memory that is
       after the allocation that is to be moved. */
    for(n = mem->next; n != NULL; n = n->next) {
      n->ptr = (void *)((char *)n->ptr + diff);
    }
  }

  mem->size = size;
  mem->real_size = mysize;
  avail_memory -= diff;
  return 1;
}

/*---------------------------------------------------------------------------*/
/**
 * \brief        Assign a chunk of memory form one mem struct to another
 * \param m_old  Old mmem struct that contains the memory
 * \param m_new  New mmem struct that will contain the memory after this call
 * \author     Daniel Willmann
 *
 *             This function is needed as mmem expects the mmem structs to be
 *             in the same order as the chunks of memory are. The new struct
 *             will be inserted into mmem's internal list at the same place
 *             the old one was.
 */
void
mmem_reparent(struct mmem *m_old, struct mmem *m_new)
{
        m_new->ptr = m_old->ptr;
        list_insert(mmemlist, m_old, m_new);
        list_remove(mmemlist, m_old);
        m_old->size = 0;
        m_old->real_size = 0;
}

/*---------------------------------------------------------------------------*/
/**
 * \brief      Initialize the managed memory module
 * \author     Adam Dunkels
 *
 *             This function initializes the managed memory module and
 *             should be called before any other function from the
 *             module.
 *
 */
void
mmem_init(void)
{
  static int inited = 0;
  if (inited) {
          PRINTF("Duplicate init\n");
          return;
  }
  list_init(mmemlist);
  avail_memory = MMEM_SIZE;
  inited = 1;
}
/*---------------------------------------------------------------------------*/

/** @} */