2012-07-15 01:31:12 +02:00
|
|
|
/****************************************************************************
|
2009-12-15 02:39:03 +01:00
|
|
|
* mm/mm_malloc.c
|
2007-02-18 00:21:28 +01:00
|
|
|
*
|
2014-08-31 16:10:15 +02:00
|
|
|
* Copyright (C) 2007, 2009, 2013-2014 Gregory Nutt. All rights reserved.
|
2012-07-15 01:31:12 +02:00
|
|
|
* Author: Gregory Nutt <gnutt@nuttx.org>
|
2007-02-18 00:21:28 +01:00
|
|
|
*
|
|
|
|
* 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.
|
2009-12-15 02:39:03 +01:00
|
|
|
* 3. Neither the name NuttX nor the names of its contributors may be
|
2007-02-18 00:21:28 +01:00
|
|
|
* 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.
|
|
|
|
*
|
2012-07-15 01:31:12 +02:00
|
|
|
****************************************************************************/
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/****************************************************************************
|
2007-02-18 00:21:28 +01:00
|
|
|
* Included Files
|
2012-07-15 01:31:12 +02:00
|
|
|
****************************************************************************/
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2013-03-08 21:36:18 +01:00
|
|
|
#include <nuttx/config.h>
|
2007-02-18 00:21:28 +01:00
|
|
|
|
|
|
|
#include <assert.h>
|
2013-04-18 19:40:38 +02:00
|
|
|
#include <debug.h>
|
2012-07-15 01:31:12 +02:00
|
|
|
|
2013-03-08 21:36:18 +01:00
|
|
|
#include <nuttx/mm.h>
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/****************************************************************************
|
2009-12-15 02:39:03 +01:00
|
|
|
* Pre-processor Definitions
|
2012-07-15 01:31:12 +02:00
|
|
|
****************************************************************************/
|
2007-02-18 00:21:28 +01:00
|
|
|
|
|
|
|
#ifndef NULL
|
|
|
|
# define NULL ((void*)0)
|
|
|
|
#endif
|
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/****************************************************************************
|
2007-02-18 00:21:28 +01:00
|
|
|
* Type Definitions
|
2012-07-15 01:31:12 +02:00
|
|
|
****************************************************************************/
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/****************************************************************************
|
2007-02-18 00:21:28 +01:00
|
|
|
* Private Data
|
2012-07-15 01:31:12 +02:00
|
|
|
****************************************************************************/
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/****************************************************************************
|
2007-02-18 00:21:28 +01:00
|
|
|
* Public Data
|
2012-07-15 01:31:12 +02:00
|
|
|
****************************************************************************/
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/****************************************************************************
|
2007-02-18 00:21:28 +01:00
|
|
|
* Private Functions
|
2012-07-15 01:31:12 +02:00
|
|
|
****************************************************************************/
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2014-08-31 18:54:55 +02:00
|
|
|
/****************************************************************************
|
|
|
|
* Public Functions
|
|
|
|
****************************************************************************/
|
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/****************************************************************************
|
2013-03-08 21:36:18 +01:00
|
|
|
* Name: mm_malloc
|
2007-02-18 00:21:28 +01:00
|
|
|
*
|
|
|
|
* Description:
|
2012-07-15 01:31:12 +02:00
|
|
|
* Find the smallest chunk that satisfies the request. Take the memory from
|
|
|
|
* that chunk, save the remaining, smaller chunk (if any).
|
2007-02-18 00:21:28 +01:00
|
|
|
*
|
|
|
|
* 8-byte alignment of the allocated data is assured.
|
|
|
|
*
|
2012-07-15 01:31:12 +02:00
|
|
|
****************************************************************************/
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2013-03-08 21:36:18 +01:00
|
|
|
FAR void *mm_malloc(FAR struct mm_heap_s *heap, size_t size)
|
2007-02-18 00:21:28 +01:00
|
|
|
{
|
2007-02-27 22:17:21 +01:00
|
|
|
FAR struct mm_freenode_s *node;
|
2007-02-18 00:21:28 +01:00
|
|
|
void *ret = NULL;
|
|
|
|
int ndx;
|
|
|
|
|
|
|
|
/* Handle bad sizes */
|
|
|
|
|
|
|
|
if (size <= 0)
|
|
|
|
{
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/* Adjust the size to account for (1) the size of the allocated node and
|
|
|
|
* (2) to make sure that it is an even multiple of our granule size.
|
2007-02-18 00:21:28 +01:00
|
|
|
*/
|
|
|
|
|
|
|
|
size = MM_ALIGN_UP(size + SIZEOF_MM_ALLOCNODE);
|
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/* We need to hold the MM semaphore while we muck with the nodelist. */
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2013-03-08 19:29:56 +01:00
|
|
|
mm_takesemaphore(heap);
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/* Get the location in the node list to start the search. Special case
|
|
|
|
* really big allocations
|
2007-02-18 00:21:28 +01:00
|
|
|
*/
|
|
|
|
|
|
|
|
if (size >= MM_MAX_CHUNK)
|
|
|
|
{
|
|
|
|
ndx = MM_NNODES-1;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
/* Convert the request size into a nodelist index */
|
|
|
|
|
|
|
|
ndx = mm_size2ndx(size);
|
|
|
|
}
|
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/* Search for a large enough chunk in the list of nodes. This list is
|
|
|
|
* ordered by size, but will have occasional zero sized nodes as we visit
|
2013-03-08 19:29:56 +01:00
|
|
|
* other mm_nodelist[] entries.
|
2007-02-18 00:21:28 +01:00
|
|
|
*/
|
|
|
|
|
2013-03-08 19:29:56 +01:00
|
|
|
for (node = heap->mm_nodelist[ndx].flink;
|
2007-02-18 00:21:28 +01:00
|
|
|
node && node->size < size;
|
|
|
|
node = node->flink);
|
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/* If we found a node with non-zero size, then this is one to use. Since
|
|
|
|
* the list is ordered, we know that is must be best fitting chunk
|
|
|
|
* available.
|
2007-02-18 00:21:28 +01:00
|
|
|
*/
|
|
|
|
|
|
|
|
if (node)
|
|
|
|
{
|
2007-02-27 22:17:21 +01:00
|
|
|
FAR struct mm_freenode_s *remainder;
|
|
|
|
FAR struct mm_freenode_s *next;
|
2007-02-21 22:55:16 +01:00
|
|
|
size_t remaining;
|
2007-02-18 00:21:28 +01:00
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/* Remove the node. There must be a predecessor, but there may not be
|
|
|
|
* a successor node.
|
2007-02-18 00:21:28 +01:00
|
|
|
*/
|
|
|
|
|
|
|
|
DEBUGASSERT(node->blink);
|
|
|
|
node->blink->flink = node->flink;
|
|
|
|
if (node->flink)
|
|
|
|
{
|
|
|
|
node->flink->blink = node->blink;
|
|
|
|
}
|
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/* Check if we have to split the free node into one of the allocated
|
|
|
|
* size and another smaller freenode. In some cases, the remaining
|
|
|
|
* bytes can be smaller (they may be SIZEOF_MM_ALLOCNODE). In that
|
|
|
|
* case, we will just carry the few wasted bytes at the end of the
|
|
|
|
* allocation.
|
2007-02-18 00:21:28 +01:00
|
|
|
*/
|
|
|
|
|
|
|
|
remaining = node->size - size;
|
|
|
|
if (remaining >= SIZEOF_MM_FREENODE)
|
|
|
|
{
|
|
|
|
/* Get a pointer to the next node in physical memory */
|
|
|
|
|
2007-02-27 22:17:21 +01:00
|
|
|
next = (FAR struct mm_freenode_s*)(((char*)node) + node->size);
|
2007-02-18 00:21:28 +01:00
|
|
|
|
|
|
|
/* Create the remainder node */
|
|
|
|
|
2007-02-27 22:17:21 +01:00
|
|
|
remainder = (FAR struct mm_freenode_s*)(((char*)node) + size);
|
2007-02-18 00:21:28 +01:00
|
|
|
remainder->size = remaining;
|
|
|
|
remainder->preceding = size;
|
|
|
|
|
|
|
|
/* Adjust the size of the node under consideration */
|
|
|
|
|
|
|
|
node->size = size;
|
|
|
|
|
2012-07-15 01:31:12 +02:00
|
|
|
/* Adjust the 'preceding' size of the (old) next node, preserving
|
|
|
|
* the allocated flag.
|
2007-02-18 00:21:28 +01:00
|
|
|
*/
|
|
|
|
|
|
|
|
next->preceding = remaining | (next->preceding & MM_ALLOC_BIT);
|
|
|
|
|
|
|
|
/* Add the remainder back into the nodelist */
|
|
|
|
|
2013-03-08 19:29:56 +01:00
|
|
|
mm_addfreechunk(heap, remainder);
|
2007-02-18 00:21:28 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Handle the case of an exact size match */
|
|
|
|
|
|
|
|
node->preceding |= MM_ALLOC_BIT;
|
|
|
|
ret = (void*)((char*)node + SIZEOF_MM_ALLOCNODE);
|
|
|
|
}
|
|
|
|
|
2013-03-08 19:29:56 +01:00
|
|
|
mm_givesemaphore(heap);
|
2013-02-28 16:31:58 +01:00
|
|
|
|
|
|
|
/* If CONFIG_DEBUG_MM is defined, then output the result of the allocation
|
|
|
|
* to the SYSLOG.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#ifdef CONFIG_DEBUG_MM
|
|
|
|
if (!ret)
|
|
|
|
{
|
|
|
|
mdbg("Allocation failed, size %d\n", size);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
mvdbg("Allocated %p, size %d\n", ret, size);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2007-02-18 00:21:28 +01:00
|
|
|
return ret;
|
|
|
|
}
|