mirror of
https://github.com/apache/nuttx.git
synced 2026-06-04 23:03:27 +08:00
NuttX RTOS
git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@3 42af7a65-404d-4744-a932-0658087f49c3
This commit is contained in:
+76
@@ -0,0 +1,76 @@
|
||||
############################################################
|
||||
# Makefile
|
||||
#
|
||||
# Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
# Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
#
|
||||
# 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 Gregory Nutt 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.
|
||||
#
|
||||
############################################################
|
||||
|
||||
-include $(TOPDIR)/Make.defs
|
||||
|
||||
MKDEP = $(TOPDIR)/tools/mkdeps.sh
|
||||
|
||||
ASRCS =
|
||||
AOBJS = $(ASRCS:.S=.o)
|
||||
CSRCS = mm_initialize.c mm_sem.c mm_addfreechunk.c mm_size2ndx.c mm_shrinkchunk.c \
|
||||
mm_malloc.c mm_zalloc.c mm_calloc.c mm_realloc.c \
|
||||
mm_memalign.c mm_free.c mm_mallinfo.c
|
||||
COBJS = $(CSRCS:.c=.o)
|
||||
|
||||
SRCS = $(ASRCS) $(CSRCS)
|
||||
OBJS = $(AOBJS) $(COBJS)
|
||||
|
||||
BIN = libmm.a
|
||||
|
||||
all: $(BIN)
|
||||
|
||||
$(AOBJS): %.o: %.S
|
||||
$(CC) -c $(CFLAGS) $< -o $@
|
||||
|
||||
$(COBJS): %.o: %.c
|
||||
$(CC) -c $(CFLAGS) $< -o $@
|
||||
|
||||
$(BIN): $(OBJS)
|
||||
$(AR) rcs $@ $(OBJS)
|
||||
|
||||
.depend: Makefile $(SRCS)
|
||||
$(MKDEP) $(CC) -- $(CFLAGS) -- $(SRCS) >Make.dep
|
||||
touch $@
|
||||
|
||||
depend: .depend
|
||||
|
||||
clean:
|
||||
rm -f $(BIN) *.o *~
|
||||
|
||||
distclean: clean
|
||||
rm -f Make.dep .depend
|
||||
|
||||
-include Make.dep
|
||||
|
||||
@@ -0,0 +1,64 @@
|
||||
############################################################
|
||||
# Makefile.test
|
||||
#
|
||||
# Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
# Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
#
|
||||
# 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 Gregory Nutt 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.
|
||||
#
|
||||
############################################################
|
||||
|
||||
SRCS = mm_test.c mm_initialize.c mm_sem.c mm_addfreechunk.c mm_size2ndx.c mm_shrinkchunk.c \
|
||||
mm_malloc.c mm_zalloc.c mm_calloc.c mm_realloc.c \
|
||||
mm_memalign.c mm_free.c mm_mallinfo.c
|
||||
OBJS = $(SRCS:.c=.o1)
|
||||
|
||||
LIBS = -lpthread -lc
|
||||
|
||||
CC = gcc
|
||||
LD = gcc
|
||||
|
||||
DEFINES = -DMM_TEST=1
|
||||
WARNIGNS = -Wall -Wstrict-prototypes -Wshadow
|
||||
CFLAGS = -g $(DEFINES)
|
||||
LDFLAGS =
|
||||
|
||||
BIN = ../mm_test
|
||||
|
||||
all: $(BIN)
|
||||
|
||||
$(OBJS): %.o1: %.c
|
||||
@echo "Compiling $<"
|
||||
$(CC) -c $(CFLAGS) $< -o $@
|
||||
|
||||
$(BIN): $(OBJS)
|
||||
@echo "Linking {$(OBJS)} to produce $@"
|
||||
$(LD) $(LDFLAGS) $(OBJS) $(LIBS) -o $@
|
||||
|
||||
clean:
|
||||
rm -f $(BIN) *.o1 *~
|
||||
@@ -0,0 +1,91 @@
|
||||
/************************************************************
|
||||
* mm_addfreechunk.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 "mm_environment.h"
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Private Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Global Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* mm_addfreechunk
|
||||
*
|
||||
* Description:
|
||||
* Add a free chunk to the node next
|
||||
* It is assumed that the caller holds the mm semaphore
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
void mm_addfreechunk(struct mm_freenode_s *node)
|
||||
{
|
||||
struct mm_freenode_s *next;
|
||||
struct mm_freenode_s *prev;
|
||||
|
||||
/* Convert the size to a nodelist index */
|
||||
|
||||
int ndx = mm_size2ndx(node->size);
|
||||
|
||||
/* Now put the new node int the next */
|
||||
|
||||
for (prev = &g_nodelist[ndx], next = g_nodelist[ndx].flink;
|
||||
next && next->size && next->size < node->size;
|
||||
prev = next, next = next->flink);
|
||||
|
||||
/* Does it go in mid next or at the end? */
|
||||
|
||||
prev->flink = node;
|
||||
node->blink = prev;
|
||||
node->flink = next;
|
||||
|
||||
if (next)
|
||||
{
|
||||
/* The new node goes between prev and next */
|
||||
|
||||
next->blink = node;
|
||||
}
|
||||
}
|
||||
@@ -0,0 +1,68 @@
|
||||
/************************************************************
|
||||
* mm_calloc.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 "mm_environment.h"
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Global Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* calloc
|
||||
*
|
||||
* Descripton:
|
||||
* calloc calculates the size and calls zalloc
|
||||
************************************************************/
|
||||
|
||||
void *calloc(size_t n, size_t elem_size)
|
||||
{
|
||||
void *ret = NULL;
|
||||
|
||||
if (n > 0 && elem_size > 0)
|
||||
{
|
||||
ret = zalloc(n * elem_size);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
@@ -0,0 +1,120 @@
|
||||
/************************************************************
|
||||
* mm_environment.h
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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.
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
#ifndef __MM_ENVIRONMENT_H
|
||||
#define __MM_ENVIRONMENT_H
|
||||
|
||||
/************************************************************
|
||||
* Included Files
|
||||
************************************************************/
|
||||
|
||||
/* The platform configuratioin file will not be included
|
||||
* when the memory manager is built for the host-based
|
||||
* test harness.
|
||||
*/
|
||||
|
||||
#ifndef MM_TEST
|
||||
# include <nuttx/config.h>
|
||||
# include <sys/types.h>
|
||||
# include <stdlib.h>
|
||||
# include <string.h>
|
||||
# include <debug.h>
|
||||
# include <errno.h>
|
||||
# include <assert.h>
|
||||
#else
|
||||
# include <sys/types.h>
|
||||
# include <string.h>
|
||||
# include <assert.h>
|
||||
#endif
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/* Special definitions used when the memory mnager is built
|
||||
* for the host-based test harness.
|
||||
*/
|
||||
|
||||
#ifdef MM_TEST
|
||||
|
||||
/* Standard types */
|
||||
|
||||
typedef unsigned int uint32;
|
||||
|
||||
/* Use the real system errno */
|
||||
|
||||
# define mm_errno errno
|
||||
|
||||
/* When built for the test harness, we change the names of the
|
||||
* exported functions so that they do not collide with the
|
||||
* host libc names.
|
||||
*/
|
||||
|
||||
# define malloc mm_malloc
|
||||
# define memalign mm_memalign
|
||||
# define realloc mm_realloc
|
||||
# define zalloc mm_zalloc
|
||||
# define calloc mm_calloc
|
||||
# define free mm_free
|
||||
|
||||
/* Use normal libc assertion functions */
|
||||
|
||||
# undef ASSERT
|
||||
# define ASSERT(e) assert(e)
|
||||
# undef DEBUGASSERT
|
||||
# define DEBUGASSERT(e) assert(e)
|
||||
|
||||
/* Debug macros are always on */
|
||||
|
||||
# define CONFIG_DEBUG
|
||||
|
||||
# undef dbg
|
||||
# define dbg(format, arg...) printf(format, ##arg)
|
||||
# undef vdg
|
||||
# define vdbg(format, arg...) printf(format, ##arg)
|
||||
|
||||
#else
|
||||
# define mm_errno (*get_errno_ptr())
|
||||
#endif
|
||||
|
||||
/************************************************************
|
||||
* Public Types
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Pulblic Function Prototypes
|
||||
************************************************************/
|
||||
|
||||
#endif /* __MM_ENVIRONMENT_H */
|
||||
+151
@@ -0,0 +1,151 @@
|
||||
/************************************************************
|
||||
* mm_free.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 <assert.h>
|
||||
#include "mm_environment.h"
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Private Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Public Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* free
|
||||
*
|
||||
* Description:
|
||||
* Returns a chunk of memory into the list of free nodes,
|
||||
* merging with adjacent free chunks if possible.
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
void free(void *mem)
|
||||
{
|
||||
struct mm_freenode_s *node;
|
||||
struct mm_freenode_s *prev;
|
||||
struct mm_freenode_s *next;
|
||||
|
||||
/* Protect against attempts to free a NULL reference */
|
||||
|
||||
if (!mem)
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
||||
/* We need to hold the MM semaphore while we muck with the
|
||||
* nodelist.
|
||||
*/
|
||||
|
||||
mm_takesemaphore();
|
||||
|
||||
/* Map the memory chunk into a free node */
|
||||
|
||||
node = (struct mm_freenode_s *)((char*)mem - SIZEOF_MM_ALLOCNODE);
|
||||
node->preceding &= ~MM_ALLOC_BIT;
|
||||
|
||||
/* Check if the following node is free and, if so, merge it */
|
||||
|
||||
next = (struct mm_freenode_s *)((char*)node + node->size);
|
||||
if ((next->preceding & MM_ALLOC_BIT) == 0)
|
||||
{
|
||||
struct mm_allocnode_s *andbeyond;
|
||||
|
||||
/* Get the node following the next node (which will
|
||||
* become the new next node). We know that we can never
|
||||
* index past the tail chunk because it is always allocated.
|
||||
*/
|
||||
|
||||
andbeyond = (struct mm_allocnode_s*)((char*)next + next->size);
|
||||
|
||||
/* Remove the next node. There must be a predecessor,
|
||||
* but there may not be a successor node.
|
||||
*/
|
||||
|
||||
DEBUGASSERT(next->blink);
|
||||
next->blink->flink = next->flink;
|
||||
if (next->flink)
|
||||
{
|
||||
next->flink->blink = next->blink;
|
||||
}
|
||||
|
||||
/* Then merge the two chunks */
|
||||
|
||||
node->size += next->size;
|
||||
andbeyond->preceding = node->size | (andbeyond->preceding & MM_ALLOC_BIT);
|
||||
next = andbeyond;
|
||||
}
|
||||
|
||||
/* Check if the preceding node is also free and, if so, merge
|
||||
* it with this node
|
||||
*/
|
||||
|
||||
prev = (struct mm_freenode_s *)((char*)node - node->preceding);
|
||||
if ((prev->preceding & MM_ALLOC_BIT) == 0)
|
||||
{
|
||||
/* Remove the node. There must be a predecessor, but there may
|
||||
* not be a successor node.
|
||||
*/
|
||||
|
||||
DEBUGASSERT(prev->blink);
|
||||
prev->blink->flink = prev->flink;
|
||||
if (prev->flink)
|
||||
{
|
||||
prev->flink->blink = prev->blink;
|
||||
}
|
||||
|
||||
/* Then merge the two chunks */
|
||||
|
||||
prev->size += node->size;
|
||||
next->preceding = prev->size | (next->preceding & MM_ALLOC_BIT);
|
||||
node = prev;
|
||||
}
|
||||
|
||||
/* Add the merged node to the nodelist */
|
||||
|
||||
mm_addfreechunk(node);
|
||||
|
||||
mm_givesemaphore();
|
||||
}
|
||||
@@ -0,0 +1,145 @@
|
||||
/************************************************************
|
||||
* mm_initialize.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 "mm_environment.h"
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Public Variables
|
||||
************************************************************/
|
||||
|
||||
/* This is the size of the heap provided to mm */
|
||||
|
||||
uint32 g_heapsize;
|
||||
|
||||
/* This is the first and last nodes of the heap */
|
||||
|
||||
struct mm_allocnode_s *g_heapstart;
|
||||
struct mm_allocnode_s *g_heapend;
|
||||
|
||||
/* All free nodes are maintained in a doubly linked list. This
|
||||
* array provides some hooks into the list at various points to
|
||||
* speed searches for free nodes.
|
||||
*/
|
||||
|
||||
struct mm_freenode_s g_nodelist[MM_NNODES];
|
||||
|
||||
/************************************************************
|
||||
* Public Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Function: mm_initialize
|
||||
*
|
||||
* Description:
|
||||
* This is an internal OS function called only at power-up
|
||||
* boot time.
|
||||
*
|
||||
* Parameters:
|
||||
* None
|
||||
*
|
||||
* Return Value:
|
||||
* None
|
||||
*
|
||||
* Assumptions:
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
void mm_initialize(void *heapstart, size_t heapsize)
|
||||
{
|
||||
struct mm_freenode_s *node;
|
||||
int i;
|
||||
|
||||
CHECK_ALLOCNODE_SIZE;
|
||||
CHECK_FREENODE_SIZE;
|
||||
|
||||
/* Adjust the provide heap start and size so that they are
|
||||
* both aligned with the MM_MIN_CHUNK size.
|
||||
*/
|
||||
|
||||
uint32 heapbase = MM_ALIGN_UP((uint32)heapstart);
|
||||
uint32 heapend = MM_ALIGN_DOWN((uint32)heapstart + (uint32)heapsize);
|
||||
|
||||
/* Save the size of the heap */
|
||||
|
||||
g_heapsize = heapend - heapbase;
|
||||
|
||||
/* Initialize the node array */
|
||||
|
||||
memset(g_nodelist, 0, sizeof(struct mm_freenode_s) * MM_NNODES);
|
||||
for (i = 1; i < MM_NNODES; i++)
|
||||
{
|
||||
g_nodelist[i-1].flink = &g_nodelist[i];
|
||||
g_nodelist[i].blink = &g_nodelist[i-1];
|
||||
}
|
||||
|
||||
/* Create two "allocated" guard nodes at the beginning and end of
|
||||
* the heap. These only serve to keep us from allocating outside
|
||||
* of the heap.
|
||||
*
|
||||
* And create one free node between the guard nodes that contains
|
||||
* all available memory.
|
||||
*/
|
||||
|
||||
g_heapstart = (struct mm_allocnode_s *)heapbase;
|
||||
g_heapstart->size = SIZEOF_MM_ALLOCNODE;
|
||||
g_heapstart->preceding = MM_ALLOC_BIT;
|
||||
|
||||
node = (struct mm_freenode_s *)(heapbase + SIZEOF_MM_ALLOCNODE);
|
||||
node->size = g_heapsize - 2*SIZEOF_MM_ALLOCNODE;
|
||||
node->preceding = SIZEOF_MM_ALLOCNODE;
|
||||
|
||||
g_heapend = (struct mm_allocnode_s *)(heapend - SIZEOF_MM_ALLOCNODE);
|
||||
g_heapend->size = SIZEOF_MM_ALLOCNODE;
|
||||
g_heapend->preceding = node->size | MM_ALLOC_BIT;
|
||||
|
||||
/* Add the single, large free node to the nodelist */
|
||||
|
||||
mm_addfreechunk(node);
|
||||
|
||||
/* Initialize the malloc semaphore to one (to support one-at-
|
||||
* a-time access to private data sets.
|
||||
*/
|
||||
|
||||
mm_seminitialize();
|
||||
}
|
||||
@@ -0,0 +1,185 @@
|
||||
/************************************************************
|
||||
* mm_internal.h
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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.
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
#ifndef __MM_INTERNAL_H
|
||||
#define __MM_INTERNAL_H
|
||||
|
||||
/************************************************************
|
||||
* Included Files
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/* These definitions define the characteristics of allocator
|
||||
*
|
||||
* MM_MIN_SHIFT is used to define MM_MIN_CHUNK.
|
||||
* MM_MIN_CHUNK - is the smallest physical chunk that can
|
||||
* be allocated. It must be at least a large as
|
||||
* sizeof(struct mm_freenode_s). Larger values may
|
||||
* improve performance slightly, but will waste memory
|
||||
* due to quantization losses.
|
||||
*
|
||||
* MM_MAX_SHIFT is used to define MM_MAX_CHUNK
|
||||
* MM_MAX_CHUNK is the largest, contiguous chunk of memory
|
||||
* that can be allocated. It can range from 16-bytes to
|
||||
* 4Gb. Larger values of MM_MAX_SHIFT can cause larger
|
||||
* data structure sizes and, perhaps, minor performance
|
||||
* losses.
|
||||
*/
|
||||
|
||||
#define MM_MIN_SHIFT 4 /* 16 bytes */
|
||||
#define MM_MAX_SHIFT 22 /* 4 Mb */
|
||||
|
||||
/* All other definitions derive from these two */
|
||||
|
||||
#define MM_MIN_CHUNK (1 << MM_MIN_SHIFT)
|
||||
#define MM_MAX_CHUNK (1 << MM_MAX_SHIFT)
|
||||
#define MM_NNODES (MM_MAX_SHIFT - MM_MIN_SHIFT + 1)
|
||||
|
||||
#define MM_GRAN_MASK (MM_MIN_CHUNK-1)
|
||||
#define MM_ALIGN_UP(a) (((a) + MM_GRAN_MASK) & ~MM_GRAN_MASK)
|
||||
#define MM_ALIGN_DOWN(a) ((a) & ~MM_GRAN_MASK)
|
||||
|
||||
/* An allocated chunk is distinguished from a free chunk by
|
||||
* bit 31 of the 'preceding' chunk size. If set, then this is
|
||||
* an allocated chunk.
|
||||
*/
|
||||
|
||||
#define MM_ALLOC_BIT 0x80000000
|
||||
#define MM_IS_ALLOCATED(n) \
|
||||
((int)((struct mm_allocnode_s*)(n)->preceding) < 0))
|
||||
|
||||
/************************************************************
|
||||
* Public Types
|
||||
************************************************************/
|
||||
|
||||
/* This describes an allocated chunk. An allocated chunk is
|
||||
* distinguished from a free chunk by bit 31 of the 'precding'
|
||||
* chunk size. If set, then this is an allocated chunk.
|
||||
*/
|
||||
|
||||
struct mm_allocnode_s
|
||||
{
|
||||
uint32 size; /* Size of this chunk */
|
||||
uint32 preceding; /* Size of the preceding chunk */
|
||||
};
|
||||
|
||||
#define SIZEOF_MM_ALLOCNODE 8
|
||||
#define CHECK_ALLOCNODE_SIZE \
|
||||
DEBUGASSERT(sizeof(struct mm_allocnode_s) == SIZEOF_MM_ALLOCNODE)
|
||||
|
||||
/* This describes a free chunk */
|
||||
|
||||
struct mm_freenode_s
|
||||
{
|
||||
uint32 size; /* Size of this chunk */
|
||||
uint32 preceding; /* Size of the preceding chunk */
|
||||
struct mm_freenode_s *flink; /* Supports a doubly linked list */
|
||||
struct mm_freenode_s *blink;
|
||||
};
|
||||
|
||||
#define SIZEOF_MM_FREENODE 16
|
||||
#define CHECK_FREENODE_SIZE \
|
||||
DEBUGASSERT(sizeof(struct mm_freenode_s) == SIZEOF_MM_FREENODE)
|
||||
|
||||
/* Normally defined in stdlib.h */
|
||||
|
||||
#ifdef MM_TEST
|
||||
struct mallinfo
|
||||
{
|
||||
int arena; /* This is the total size of memory allocated
|
||||
* for use by malloc in bytes. */
|
||||
int ordblks; /* This is the number of free (not in use) chunks */
|
||||
int mxordblk; /* Size of the largest free (not in use) chunk */
|
||||
int uordblks; /* This is the total size of memory occupied by
|
||||
* chunks handed out by malloc. */
|
||||
int fordblks; /* This is the total size of memory occupied
|
||||
* by free (not in use) chunks.*/
|
||||
};
|
||||
#endif
|
||||
|
||||
/************************************************************
|
||||
* Global Variables
|
||||
************************************************************/
|
||||
|
||||
/* This is the size of the heap provided to mm */
|
||||
|
||||
extern uint32 g_heapsize;
|
||||
|
||||
/* This is the first and last nodes of the heap */
|
||||
|
||||
extern struct mm_allocnode_s *g_heapstart;
|
||||
extern struct mm_allocnode_s *g_heapend;
|
||||
|
||||
/* All free nodes are maintained in a doubly linked list. This
|
||||
* array provides some hooks into the list at various points to
|
||||
* speed searches for free nodes.
|
||||
*/
|
||||
|
||||
extern struct mm_freenode_s g_nodelist[MM_NNODES];
|
||||
|
||||
/************************************************************
|
||||
* Inline Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Pulblic Function Prototypes
|
||||
************************************************************/
|
||||
|
||||
/* Normally defined in malloc.h */
|
||||
|
||||
#ifdef MM_TEST
|
||||
extern void *mm_malloc(size_t);
|
||||
extern void mm_free(void*);
|
||||
extern void *mm_realloc(void*, size_t);
|
||||
extern void *mm_memalign(size_t, size_t);
|
||||
extern void *mm_zalloc(size_t);
|
||||
extern void *mm_calloc(size_t, size_t);
|
||||
extern struct mallinfo mallinfo(void);
|
||||
#endif
|
||||
|
||||
extern void mm_shrinkchunk(struct mm_allocnode_s *node, uint32 size);
|
||||
extern void mm_addfreechunk(struct mm_freenode_s *node);
|
||||
extern int mm_size2ndx(uint32 size);
|
||||
extern void mm_seminitialize(void);
|
||||
extern void mm_takesemaphore(void);
|
||||
extern void mm_givesemaphore(void);
|
||||
#ifdef MM_TEST
|
||||
extern int mm_getsemaphore(void);
|
||||
#endif
|
||||
|
||||
#endif /* __MM_INTERNAL_H */
|
||||
@@ -0,0 +1,108 @@
|
||||
/************************************************************
|
||||
* mm_mallinfo.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 <assert.h>
|
||||
#include "mm_environment.h"
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Private Data
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Private Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Public Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* mallinfo
|
||||
*
|
||||
* Description:
|
||||
* mallinfo returns a copy of updated current mallinfo.
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
struct mallinfo mallinfo(void)
|
||||
{
|
||||
static struct mallinfo stats;
|
||||
struct mm_allocnode_s *node;
|
||||
uint32 mxordblk = 0;
|
||||
int ordblks = 0; /* Number of non-inuse chunks */
|
||||
uint32 uordblks = 0; /* Total allocated space */
|
||||
uint32 fordblks = 0; /* Total non-inuse space */
|
||||
|
||||
/* Visit each node in physical memory */
|
||||
|
||||
for (node = g_heapstart;
|
||||
node < g_heapend;
|
||||
node = (struct mm_allocnode_s *)((char*)node + node->size))
|
||||
{
|
||||
if (node->preceding & MM_ALLOC_BIT)
|
||||
{
|
||||
uordblks += node->size;
|
||||
}
|
||||
else
|
||||
{
|
||||
ordblks++;
|
||||
fordblks += node->size;
|
||||
if (node->size > mxordblk)
|
||||
{
|
||||
mxordblk = node->size;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
DEBUGASSERT(node == g_heapend);
|
||||
uordblks += SIZEOF_MM_ALLOCNODE; /* account for the tail node */
|
||||
DEBUGASSERT(uordblks + fordblks == g_heapsize);
|
||||
|
||||
stats.arena = g_heapsize;
|
||||
stats.ordblks = ordblks;
|
||||
stats.mxordblk = mxordblk;
|
||||
stats.uordblks = uordblks;
|
||||
stats.fordblks = fordblks;
|
||||
return stats;
|
||||
}
|
||||
+203
@@ -0,0 +1,203 @@
|
||||
/************************************************************
|
||||
* mm_malloc.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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
|
||||
************************************************************/
|
||||
|
||||
/* Special definitions when we operate in the normal vs. the
|
||||
* host-pc test environement.
|
||||
*/
|
||||
|
||||
#include <assert.h>
|
||||
#include "mm_environment.h"
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
#ifndef NULL
|
||||
# define NULL ((void*)0)
|
||||
#endif
|
||||
|
||||
/************************************************************
|
||||
* Type Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Private Data
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Public Data
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Private Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Public Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* malloc
|
||||
*
|
||||
* Description:
|
||||
* Find the smallest chunk that satisfies the request.
|
||||
* Take the memory from that chunk, save the remaining,
|
||||
* smaller chunk (if any).
|
||||
*
|
||||
* 8-byte alignment of the allocated data is assured.
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
void *malloc(size_t size)
|
||||
{
|
||||
struct mm_freenode_s *node;
|
||||
void *ret = NULL;
|
||||
int ndx;
|
||||
|
||||
/* Handle bad sizes */
|
||||
|
||||
if (size <= 0)
|
||||
{
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* 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.
|
||||
*/
|
||||
|
||||
size = MM_ALIGN_UP(size + SIZEOF_MM_ALLOCNODE);
|
||||
|
||||
/* We need to hold the MM semaphore while we muck with the
|
||||
* nodelist.
|
||||
*/
|
||||
|
||||
mm_takesemaphore();
|
||||
|
||||
/* Get the location in the node list to start the search.
|
||||
* Special case really big alloctions
|
||||
*/
|
||||
|
||||
if (size >= MM_MAX_CHUNK)
|
||||
{
|
||||
ndx = MM_NNODES-1;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Convert the request size into a nodelist index */
|
||||
|
||||
ndx = mm_size2ndx(size);
|
||||
}
|
||||
|
||||
/* 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 other g_nodelist[] entries.
|
||||
*/
|
||||
|
||||
for (node = g_nodelist[ndx].flink;
|
||||
node && node->size < size;
|
||||
node = node->flink);
|
||||
|
||||
/* 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.
|
||||
*/
|
||||
|
||||
if (node)
|
||||
{
|
||||
struct mm_freenode_s *remainder;
|
||||
struct mm_freenode_s *next;
|
||||
uint32 remaining;
|
||||
|
||||
/* Remove the node. There must be a predecessor, but there may
|
||||
* not be a successor node.
|
||||
*/
|
||||
|
||||
DEBUGASSERT(node->blink);
|
||||
node->blink->flink = node->flink;
|
||||
if (node->flink)
|
||||
{
|
||||
node->flink->blink = node->blink;
|
||||
}
|
||||
|
||||
/* 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.
|
||||
*/
|
||||
|
||||
remaining = node->size - size;
|
||||
if (remaining >= SIZEOF_MM_FREENODE)
|
||||
{
|
||||
/* Get a pointer to the next node in physical memory */
|
||||
|
||||
next = (struct mm_freenode_s*)(((char*)node) + node->size);
|
||||
|
||||
/* Create the remainder node */
|
||||
|
||||
remainder = (struct mm_freenode_s*)(((char*)node) + size);
|
||||
remainder->size = remaining;
|
||||
remainder->preceding = size;
|
||||
|
||||
/* Adjust the size of the node under consideration */
|
||||
|
||||
node->size = size;
|
||||
|
||||
/* Adjust the 'preceding' size of the (old) next node,
|
||||
* preserving the allocated flag.
|
||||
*/
|
||||
|
||||
next->preceding = remaining | (next->preceding & MM_ALLOC_BIT);
|
||||
|
||||
/* Add the remainder back into the nodelist */
|
||||
|
||||
mm_addfreechunk(remainder);
|
||||
}
|
||||
|
||||
/* Handle the case of an exact size match */
|
||||
|
||||
node->preceding |= MM_ALLOC_BIT;
|
||||
ret = (void*)((char*)node + SIZEOF_MM_ALLOCNODE);
|
||||
}
|
||||
|
||||
mm_givesemaphore();
|
||||
return ret;
|
||||
}
|
||||
@@ -0,0 +1,212 @@
|
||||
/************************************************************
|
||||
* mm_memalign.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 <assert.h>
|
||||
#include "mm_environment.h"
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Global Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* memalign
|
||||
*
|
||||
* Description:
|
||||
* memalign requests more than enough space from malloc,
|
||||
* finds a region within that chunk that meets the alignment
|
||||
* request and then frees any leading or trailing space.
|
||||
*
|
||||
* The alignment argument must be a power of two (not
|
||||
* checked). 8-byte alignment is guaranteed by normal
|
||||
* malloc calls.
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
void *memalign(size_t alignment, size_t size)
|
||||
{
|
||||
struct mm_allocnode_s *node;
|
||||
uint32 rawchunk;
|
||||
uint32 alignedchunk;
|
||||
uint32 mask = (uint32)(alignment - 1);
|
||||
uint32 allocsize;
|
||||
|
||||
/* If this requested alignement less than or equal to the
|
||||
* natural alignment of malloc, then just let malloc do the
|
||||
* work.
|
||||
*/
|
||||
|
||||
if (alignment <= MM_MIN_CHUNK)
|
||||
{
|
||||
return malloc(size);
|
||||
}
|
||||
|
||||
/* Adjust the size to account for (1) the size of the allocated
|
||||
* node, (2) to make sure that it is an even multiple of
|
||||
* our granule size, and to include the alignment amount.
|
||||
*
|
||||
* Notice that we increase the allocation size by twice the
|
||||
* the requested alignment. We do this so that there will
|
||||
* be at least two valid alignment points within the allocated
|
||||
* memory.
|
||||
*
|
||||
* NOTE: These are sizes given to malloc and not chunk sizes.
|
||||
* The do not include SIZEOF_MM_ALLOCNODE.
|
||||
*/
|
||||
|
||||
size = MM_ALIGN_UP(size); /* Make mutliples of our granule size */
|
||||
allocsize = size + 2*alignment; /* Add double full alignment size */
|
||||
|
||||
/* If the alignment is small
|
||||
|
||||
/* Then malloc that size */
|
||||
|
||||
rawchunk = (uint32)malloc(allocsize);
|
||||
if (!rawchunk)
|
||||
{
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* We need to hold the MM semaphore while we muck with the
|
||||
* chunks and nodelist.
|
||||
*/
|
||||
|
||||
mm_takesemaphore();
|
||||
|
||||
/* Get the node associated with the allocation and the next
|
||||
* node after the allocation.
|
||||
*/
|
||||
|
||||
node = (struct mm_allocnode_s*)(rawchunk - SIZEOF_MM_ALLOCNODE);
|
||||
|
||||
/* Find the aligned subregion */
|
||||
|
||||
alignedchunk = (rawchunk + mask) & ~mask;
|
||||
|
||||
/* Check if there is free space at the beginning of the aligned chunk */
|
||||
|
||||
if (alignedchunk != rawchunk)
|
||||
{
|
||||
struct mm_allocnode_s *newnode;
|
||||
struct mm_allocnode_s *next;
|
||||
uint32 precedingsize;
|
||||
|
||||
/* Get the node the next node after the allocation. */
|
||||
|
||||
next = (struct mm_allocnode_s*)((char*)node + node->size);
|
||||
|
||||
/* Make sure that there is space to convert the preceding mm_allocnode_s
|
||||
* into an mm_freenode_s. I think that this should always be true
|
||||
*/
|
||||
|
||||
DEBUGASSERT(alignedchunk >= rawchunk + 8);
|
||||
|
||||
newnode = (struct mm_allocnode_s*)(alignedchunk - SIZEOF_MM_ALLOCNODE);
|
||||
|
||||
/* Preceding size is full size of the new 'node,' including
|
||||
* SIZEOF_MM_ALLOCNODE
|
||||
*/
|
||||
|
||||
precedingsize = (uint32)newnode - (uint32)node;
|
||||
|
||||
/* If we were unlucky, then the alignedchunk can lie in such
|
||||
* a position that precedingsize < SIZEOF_NODE_FREENODE. We
|
||||
* can't let that happen because we are going to cast 'node' to
|
||||
* struct mm_freenode_s below. This is why we allocated memory
|
||||
* large enough to support two alignment points. In this case,
|
||||
* we will simply use the second alignment point.
|
||||
*/
|
||||
|
||||
if (precedingsize < SIZEOF_MM_FREENODE)
|
||||
{
|
||||
alignedchunk += alignment;
|
||||
newnode = (struct mm_allocnode_s*)(alignedchunk - SIZEOF_MM_ALLOCNODE);
|
||||
precedingsize = (uint32)newnode - (uint32)node;
|
||||
}
|
||||
|
||||
/* Set up the size of the new node */
|
||||
|
||||
newnode->size = (uint32)next - (uint32)newnode;
|
||||
newnode->preceding = precedingsize | MM_ALLOC_BIT;
|
||||
|
||||
/* Reduce the size of the original chunk and mark it not allocated, */
|
||||
|
||||
node->size = precedingsize;
|
||||
node->preceding &= ~MM_ALLOC_BIT;
|
||||
|
||||
/* Fix the preceding size of the next node */
|
||||
|
||||
next->preceding = newnode->size | (next->preceding & MM_ALLOC_BIT);
|
||||
|
||||
/* Convert the newnode chunk size back into malloc-compatible
|
||||
* size by subtracting the header size SIZEOF_MM_ALLOCNODE.
|
||||
*/
|
||||
|
||||
allocsize = newnode->size - SIZEOF_MM_ALLOCNODE;
|
||||
|
||||
/* Add the original, newly freed node to the free nodelist */
|
||||
|
||||
mm_addfreechunk((struct mm_freenode_s *)node);
|
||||
|
||||
/* Replace the original node with the newlay realloaced,
|
||||
* aligned node
|
||||
*/
|
||||
|
||||
node = newnode;
|
||||
}
|
||||
|
||||
/* Check if there is free space at the end of the aligned chunk */
|
||||
|
||||
if (allocsize > size)
|
||||
{
|
||||
/* Shrink the chunk by that much -- remember, mm_shrinkchunk
|
||||
* wants internal chunk sizes that include SIZEOF_MM_ALLOCNODE,
|
||||
* and not the malloc-compatible sizes that we have.
|
||||
*/
|
||||
|
||||
mm_shrinkchunk(node, size + SIZEOF_MM_ALLOCNODE);
|
||||
}
|
||||
|
||||
mm_givesemaphore();
|
||||
return (void*)alignedchunk;
|
||||
}
|
||||
+336
@@ -0,0 +1,336 @@
|
||||
/************************************************************
|
||||
* mm_realloc.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 <string.h>
|
||||
#include "mm_environment.h"
|
||||
#include <stdio.h> /* For NULL */
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Global Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* realloc
|
||||
*
|
||||
* Description:
|
||||
* If the reallocation is for less space, then:
|
||||
* (1) the current allocation is reduced in size
|
||||
* (2) the remainder at the end of the allocation is
|
||||
* returned to the free list.
|
||||
*
|
||||
* If the request is for more space and the current
|
||||
* allocation can be extended, it will be extended by:
|
||||
* (1) Taking the additional space from the following
|
||||
* free chunk, or
|
||||
* (2) Taking the additional space from the preceding
|
||||
* free chunk.
|
||||
* (3) Or both
|
||||
*
|
||||
* If the request is for more space but the current chunk
|
||||
* cannot be extended, then malloc a new buffer, copy the
|
||||
* data into the new buffer, and free the old buffer.
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
void *realloc(void *oldmem, size_t size)
|
||||
{
|
||||
struct mm_allocnode_s *oldnode;
|
||||
struct mm_freenode_s *prev;
|
||||
struct mm_freenode_s *next;
|
||||
uint32 oldsize;
|
||||
uint32 prevsize = 0;
|
||||
uint32 nextsize = 0;
|
||||
|
||||
/* If oldmem is NULL, then realloc is equivalent to malloc */
|
||||
|
||||
if (!oldmem)
|
||||
{
|
||||
return malloc(size);
|
||||
}
|
||||
|
||||
/* If size is zero, then realloc is equivalent to free */
|
||||
|
||||
if (size <= 0)
|
||||
{
|
||||
free(oldmem);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* 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.
|
||||
*/
|
||||
|
||||
size = MM_ALIGN_UP(size + SIZEOF_MM_ALLOCNODE);
|
||||
|
||||
/* Map the memory chunk into an allocated node structure */
|
||||
|
||||
oldnode = (struct mm_allocnode_s *)((char*)oldmem - SIZEOF_MM_ALLOCNODE);
|
||||
|
||||
/* We need to hold the MM semaphore while we muck with the
|
||||
* nodelist.
|
||||
*/
|
||||
|
||||
mm_takesemaphore();
|
||||
|
||||
/* Check if this is a request to reduce the size of the allocation. */
|
||||
|
||||
oldsize = oldnode->size;
|
||||
if (size <= oldsize)
|
||||
{
|
||||
mm_shrinkchunk(oldnode, size);
|
||||
mm_givesemaphore();
|
||||
return oldmem;
|
||||
}
|
||||
|
||||
/* This is a request to increase the size of the allocation, Get the
|
||||
* available sizes before and after the oldnode so that we can make
|
||||
* the best decision
|
||||
*/
|
||||
|
||||
next = (struct mm_freenode_s *)((char*)oldnode + oldnode->size);
|
||||
if ((next->preceding & MM_ALLOC_BIT) == 0)
|
||||
{
|
||||
nextsize = next->size;
|
||||
}
|
||||
|
||||
prev = (struct mm_freenode_s *)((char*)oldnode - (oldnode->preceding & ~MM_ALLOC_BIT));
|
||||
if ((prev->preceding & MM_ALLOC_BIT) == 0)
|
||||
{
|
||||
prevsize = prev->size;
|
||||
}
|
||||
|
||||
/* Now, check if we can extend the current allocation or not */
|
||||
|
||||
if (nextsize + prevsize + oldsize >= size)
|
||||
{
|
||||
uint32 needed = size - oldsize;
|
||||
uint32 takeprev;
|
||||
uint32 takenext;
|
||||
|
||||
/* Check if we can extend into the previous chunk and if the
|
||||
* previous chunk is smaller than the next chunk.
|
||||
*/
|
||||
|
||||
if (prevsize > 0 && (nextsize >= prevsize || nextsize <= 0))
|
||||
{
|
||||
/* Can we get everything we need from the previous chunk? */
|
||||
|
||||
if (needed > prevsize)
|
||||
{
|
||||
/* No, take the whole previous chunk and get the
|
||||
* rest that we need from the next chunk.
|
||||
*/
|
||||
|
||||
takeprev = prevsize;
|
||||
takenext = needed - prevsize;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Yes, take what we need from the previous chunk */
|
||||
|
||||
takeprev = needed;
|
||||
takenext = 0;
|
||||
}
|
||||
|
||||
needed = 0;
|
||||
}
|
||||
|
||||
/* Check if we can extend into the next chunk and if we still
|
||||
* need more memory.
|
||||
*/
|
||||
|
||||
if (nextsize > 0 && needed)
|
||||
{
|
||||
/* Can we get everything we need from the next chunk? */
|
||||
|
||||
if (needed > nextsize)
|
||||
{
|
||||
/* No, take the whole next chunk and get the
|
||||
* rest that we need from the previous chunk.
|
||||
*/
|
||||
|
||||
takeprev = needed - nextsize;
|
||||
takenext = nextsize;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Yes, take what we need from the previous chunk */
|
||||
|
||||
takeprev = 0;
|
||||
takenext = needed;
|
||||
}
|
||||
}
|
||||
|
||||
/* Extend into the previous free chunk */
|
||||
|
||||
if (takeprev)
|
||||
{
|
||||
struct mm_allocnode_s *newnode;
|
||||
|
||||
/* Remove the previous node. There must be a predecessor,
|
||||
* but there may not be a successor node.
|
||||
*/
|
||||
|
||||
DEBUGASSERT(prev->blink);
|
||||
prev->blink->flink = prev->flink;
|
||||
if (prev->flink)
|
||||
{
|
||||
prev->flink->blink = prev->blink;
|
||||
}
|
||||
|
||||
/* Extend the node into the previous free chunk */
|
||||
|
||||
newnode = (struct mm_allocnode_s *)((char*)oldnode - takeprev);
|
||||
|
||||
/* Did we consume the entire preceding chunk? */
|
||||
|
||||
if (takeprev < prevsize)
|
||||
{
|
||||
/* No, just take what we need from the previous chunk
|
||||
* and put it back into the free list
|
||||
*/
|
||||
|
||||
prev->size -= takeprev;
|
||||
newnode->size = oldsize + takeprev;
|
||||
newnode->preceding = prev->size | MM_ALLOC_BIT;
|
||||
next->preceding = newnode->size | (next->preceding & MM_ALLOC_BIT);
|
||||
|
||||
/* Return the previous free node to the nodelist (with the new size) */
|
||||
|
||||
mm_addfreechunk(prev);
|
||||
|
||||
/* Now we want to return newnode */
|
||||
|
||||
oldnode = newnode;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Yes update its size (newnode->preceding is already set) */
|
||||
|
||||
newnode->size += oldsize;
|
||||
next->preceding = newnode->size;
|
||||
}
|
||||
|
||||
oldnode = newnode;
|
||||
oldsize = newnode->size;
|
||||
}
|
||||
|
||||
/* Extend into the next free chunk */
|
||||
|
||||
if (takenext)
|
||||
{
|
||||
struct mm_freenode_s *newnode;
|
||||
struct mm_allocnode_s *andbeyond;
|
||||
|
||||
/* Get the chunk following the next node (which could be the tail chunk) */
|
||||
|
||||
andbeyond = (struct mm_allocnode_s*)((char*)next + nextsize);
|
||||
|
||||
/* Remove the next node. There must be a predecessor,
|
||||
* but there may not be a successor node.
|
||||
*/
|
||||
|
||||
DEBUGASSERT(next->blink);
|
||||
next->blink->flink = next->flink;
|
||||
if (next->flink)
|
||||
{
|
||||
next->flink->blink = next->blink;
|
||||
}
|
||||
|
||||
/* Extend the node into the previous next chunk */
|
||||
|
||||
oldnode->size = oldsize + takenext;
|
||||
newnode = (struct mm_freenode_s *)((char*)oldnode + oldnode->size);
|
||||
|
||||
/* Did we consume the entire preceding chunk? */
|
||||
|
||||
if (takenext < nextsize)
|
||||
{
|
||||
/* No, take what we need from the next chunk and return it
|
||||
* to the free nodelist.
|
||||
*/
|
||||
|
||||
newnode->size = nextsize - takenext;
|
||||
newnode->preceding = oldnode->size;
|
||||
andbeyond->preceding = newnode->size | (andbeyond->preceding & MM_ALLOC_BIT);
|
||||
|
||||
/* Add the new free node to the nodelist (with the new size) */
|
||||
|
||||
mm_addfreechunk(newnode);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Yes, just update some pointers. */
|
||||
|
||||
andbeyond->preceding = oldnode->size | (andbeyond->preceding & MM_ALLOC_BIT);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
mm_givesemaphore();
|
||||
return (void*)((char*)oldnode + SIZEOF_MM_ALLOCNODE);
|
||||
}
|
||||
|
||||
/* The current chunk cannot be extended. Just allocate a new chunk and copy */
|
||||
|
||||
else
|
||||
{
|
||||
/* Allocate a new block. On failure, realloc must return NULL but
|
||||
* leave the original memory in place.
|
||||
*/
|
||||
|
||||
mm_givesemaphore();
|
||||
char *newmem = (char*)malloc(size);
|
||||
if (newmem)
|
||||
{
|
||||
memcpy(newmem, oldmem, oldsize);
|
||||
free(oldmem);
|
||||
}
|
||||
|
||||
return newmem;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
+177
@@ -0,0 +1,177 @@
|
||||
/************************************************************
|
||||
* mm_sem.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 "mm_environment.h"
|
||||
#include <unistd.h>
|
||||
#include <semaphore.h>
|
||||
#include <errno.h>
|
||||
#include <assert.h>
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/* Define the following to enable semaphore state monitoring */
|
||||
//#define MONITOR_MM_SEMAPHORE 1
|
||||
|
||||
#ifdef MONITOR_MM_SEMAPHORE
|
||||
# ifdef CONFIG_DEBUG
|
||||
# include <debug.h>
|
||||
# define msemdbg dbg
|
||||
# else
|
||||
# define msemdbg printf
|
||||
# endif
|
||||
#else
|
||||
# define msemdbg(x...)
|
||||
#endif
|
||||
|
||||
/************************************************************
|
||||
* Private Data
|
||||
************************************************************/
|
||||
|
||||
/* Mutually exclusive access to this data set is enforced with
|
||||
* the following (un-named) semaphore. */
|
||||
|
||||
static sem_t g_mm_semaphore;
|
||||
static pid_t g_holder;
|
||||
static int g_counts_held;
|
||||
|
||||
/************************************************************
|
||||
* Public Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* mm_seminitialize
|
||||
************************************************************/
|
||||
|
||||
void mm_seminitialize(void)
|
||||
{
|
||||
/* Initialize the MM semaphore to one (to support one-at-
|
||||
* a-time access to private data sets.
|
||||
*/
|
||||
|
||||
(void)sem_init(&g_mm_semaphore, 0, 1);
|
||||
|
||||
g_holder = -1;
|
||||
g_counts_held = 0;
|
||||
}
|
||||
|
||||
/************************************************************
|
||||
* mm_takesemaphore
|
||||
************************************************************/
|
||||
|
||||
void mm_takesemaphore(void)
|
||||
{
|
||||
pid_t my_pid = getpid();
|
||||
|
||||
/* Do I already have the semaphore? */
|
||||
|
||||
if (g_holder == my_pid)
|
||||
{
|
||||
/* Yes, just increment the number of references that I have */
|
||||
|
||||
g_counts_held++;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Take the semaphore (perhaps waiting) */
|
||||
|
||||
msemdbg("%s: PID=%d taking\n", __FUNCTION__, my_pid);
|
||||
while (sem_wait(&g_mm_semaphore) != 0)
|
||||
{
|
||||
/* The only case that an error should occur here is if
|
||||
* the wait was awakened by a signal.
|
||||
*/
|
||||
|
||||
ASSERT(mm_errno == EINTR);
|
||||
}
|
||||
|
||||
/* We have it. Claim the stak and return */
|
||||
|
||||
g_holder = my_pid;
|
||||
g_counts_held = 1;
|
||||
}
|
||||
|
||||
msemdbg("%s: Holder=%d count=%d\n",
|
||||
__FUNCTION__, g_holder, g_counts_held);
|
||||
}
|
||||
|
||||
/************************************************************
|
||||
* mm_givesemaphore
|
||||
************************************************************/
|
||||
|
||||
void mm_givesemaphore(void)
|
||||
{
|
||||
pid_t my_pid = getpid();
|
||||
|
||||
/* I better be holding at least one reference to the semaphore */
|
||||
|
||||
ASSERT(g_holder == my_pid);
|
||||
|
||||
/* Do I hold multiple references to the semphore */
|
||||
|
||||
if (g_counts_held > 1)
|
||||
{
|
||||
/* Yes, just release one count and return */
|
||||
|
||||
g_counts_held--;
|
||||
msemdbg("%s: Holder=%d count=%d\n",
|
||||
__FUNCTION__, g_holder, g_counts_held);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Nope, this is the last reference I have */
|
||||
|
||||
msemdbg("%s: PID=%d giving\n", __FUNCTION__, my_pid);
|
||||
g_holder = -1;
|
||||
g_counts_held = 0;
|
||||
ASSERT(sem_post(&g_mm_semaphore) == 0);
|
||||
}
|
||||
}
|
||||
|
||||
#ifdef MM_TEST
|
||||
int mm_getsemaphore(void)
|
||||
{
|
||||
int sval;
|
||||
sem_getvalue(&g_mm_semaphore, &sval);
|
||||
return sval;
|
||||
}
|
||||
#endif
|
||||
|
||||
@@ -0,0 +1,140 @@
|
||||
/************************************************************
|
||||
* mm_shrinkchunk.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 "mm_environment.h"
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Global Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* mm_shrinkchunk
|
||||
*
|
||||
* Description:
|
||||
* Reduce the size of the chunk specified by the node
|
||||
* structure to the specified size. this internal logic
|
||||
* is used both from memalign to dispose of any trailing
|
||||
* memory in the the aligned allocation and also by realloc
|
||||
* when there is a request to reduce the size of an allocation.
|
||||
*
|
||||
* NOTES:
|
||||
* (1) size is the whole chunk size (payload and header)
|
||||
* (2) the caller must hold the MM semaphore.
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
void mm_shrinkchunk(struct mm_allocnode_s *node, uint32 size)
|
||||
{
|
||||
struct mm_freenode_s *next;
|
||||
|
||||
/* Get a reference to the next node */
|
||||
|
||||
next = (struct mm_freenode_s*)((char*)node + node->size);
|
||||
|
||||
/* Check if it is free */
|
||||
|
||||
if ((next->preceding & MM_ALLOC_BIT) == 0)
|
||||
{
|
||||
struct mm_allocnode_s *andbeyond;
|
||||
struct mm_freenode_s *newnode;
|
||||
|
||||
/* Get the chunk next the next node (which could be the tail chunk) */
|
||||
|
||||
andbeyond = (struct mm_allocnode_s*)((char*)next + next->size);
|
||||
|
||||
/* Remove the next node. There must be a predecessor, but there may
|
||||
* not be a successor node.
|
||||
*/
|
||||
|
||||
DEBUGASSERT(next->blink);
|
||||
next->blink->flink = next->flink;
|
||||
if (next->flink)
|
||||
{
|
||||
next->flink->blink = next->blink;
|
||||
}
|
||||
|
||||
/* Create a new chunk that will hold both the next chunk
|
||||
* and the tailing memory from the aligned chunk.
|
||||
*/
|
||||
|
||||
newnode = (struct mm_freenode_s*)((char*)node + size);
|
||||
|
||||
/* Set up the size of the new node */
|
||||
|
||||
newnode->size = next->size + node->size - size;
|
||||
newnode->preceding = size;
|
||||
node->size = size;
|
||||
andbeyond->preceding = newnode->size | (andbeyond->preceding & MM_ALLOC_BIT);
|
||||
|
||||
/* Add the new node to the freenodelist */
|
||||
|
||||
mm_addfreechunk(newnode);
|
||||
}
|
||||
|
||||
/* The next chunk is allocated. Try to free the end portion
|
||||
* at the end chunk to be shrunk.
|
||||
*/
|
||||
|
||||
else if (node->size >= size + SIZEOF_MM_FREENODE)
|
||||
{
|
||||
struct mm_freenode_s *newnode;
|
||||
|
||||
/* Create a new chunk that will hold both the next chunk
|
||||
* and the tailing memory from the aligned chunk.
|
||||
*/
|
||||
|
||||
newnode = (struct mm_freenode_s*)((char*)node + size);
|
||||
|
||||
/* Set up the size of the new node */
|
||||
|
||||
newnode->size = node->size - size;
|
||||
newnode->preceding = size;
|
||||
node->size = size;
|
||||
next->preceding = newnode->size | MM_ALLOC_BIT;
|
||||
|
||||
/* Add the new node to the freenodelist */
|
||||
|
||||
mm_addfreechunk(newnode);
|
||||
}
|
||||
}
|
||||
@@ -0,0 +1,70 @@
|
||||
/************************************************************
|
||||
* mm_size2ndx.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 "mm_environment.h"
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Public Functions
|
||||
************************************************************/
|
||||
|
||||
/* Convert the size to a nodelist index */
|
||||
|
||||
int mm_size2ndx(uint32 size)
|
||||
{
|
||||
int ndx = 0;
|
||||
|
||||
if (size >= MM_MAX_CHUNK)
|
||||
{
|
||||
return MM_NNODES-1;
|
||||
}
|
||||
|
||||
size >>= MM_MIN_SHIFT;
|
||||
while (size > 1)
|
||||
{
|
||||
ndx++;
|
||||
size >>= 1;
|
||||
}
|
||||
|
||||
return ndx;
|
||||
}
|
||||
+439
@@ -0,0 +1,439 @@
|
||||
/************************************************************
|
||||
* mm_test.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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.
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
|
||||
typedef unsigned int uint32;
|
||||
#include "mm_internal.h"
|
||||
|
||||
/* Definitions */
|
||||
|
||||
#define TEST_HEAP_SIZE 0x00100000
|
||||
#define NTEST_ALLOCS 32
|
||||
|
||||
/* #define STOP_ON_ERRORS do{}while(0) */
|
||||
#define STOP_ON_ERRORS exit(1)
|
||||
|
||||
/* Heap provided to memory manager */
|
||||
|
||||
unsigned long heap_base;
|
||||
unsigned long heap_size = TEST_HEAP_SIZE;
|
||||
|
||||
/* Test allocations */
|
||||
|
||||
static const int alloc_sizes[NTEST_ALLOCS] =
|
||||
{
|
||||
1024, 12, 962, 5692, 10254, 111, 9932, 601,
|
||||
222, 2746, 3, 124321, 68, 776, 6750, 852,
|
||||
4732, 28, 901, 480, 5011, 1536, 2011, 81647,
|
||||
646, 1646, 69179, 194, 2590, 7, 969, 70
|
||||
};
|
||||
static const int realloc_sizes[NTEST_ALLOCS] =
|
||||
{
|
||||
18, 3088, 963, 123, 511, 11666, 3723, 42,
|
||||
9374, 1990, 1412, 6, 592, 4088, 11, 5040,
|
||||
8663, 91255, 28, 4346, 9172, 168, 229, 4734,
|
||||
59139, 221, 7830, 30421, 1666, 4, 812, 416
|
||||
};
|
||||
static const int random1[NTEST_ALLOCS] =
|
||||
{
|
||||
20, 11, 3, 31, 9, 29, 7, 17,
|
||||
21, 2, 26, 18, 14, 25, 0, 10,
|
||||
27, 19, 22, 28, 8, 30, 12, 15,
|
||||
4, 1, 24, 6, 16, 13, 5, 23
|
||||
};
|
||||
static const int random2[NTEST_ALLOCS] =
|
||||
{
|
||||
2, 19, 12, 23, 30, 11, 27, 4,
|
||||
20, 7, 0, 16, 28, 15, 5, 24,
|
||||
10, 17, 25, 31, 8, 29, 3, 26,
|
||||
9, 18, 22, 13, 1, 21, 14, 6
|
||||
};
|
||||
static const int random3[NTEST_ALLOCS] =
|
||||
{
|
||||
8, 17, 3, 18, 26, 23, 30, 11,
|
||||
12, 22, 4, 20, 25, 10, 27, 1,
|
||||
29, 14, 19, 21, 0, 31, 7, 24,
|
||||
9, 15, 2, 28, 16, 6, 13, 5
|
||||
};
|
||||
static const int alignment[NTEST_ALLOCS/2] =
|
||||
{
|
||||
128, 2048, 131072, 8192, 32, 32768, 16384 , 262144,
|
||||
512, 4096, 65536, 8, 64, 1024, 16, 4
|
||||
};
|
||||
static void *allocs[NTEST_ALLOCS];
|
||||
static struct mallinfo alloc_info;
|
||||
static unsigned int g_adjheapsize = 0;
|
||||
|
||||
/************************************************************
|
||||
* mm_showchunkinfo
|
||||
************************************************************/
|
||||
|
||||
static int mm_findinfreelist(struct mm_freenode_s *node)
|
||||
{
|
||||
struct mm_freenode_s *list;
|
||||
|
||||
for(list = &g_nodelist[0];
|
||||
list;
|
||||
list = list->flink)
|
||||
{
|
||||
if (list == node)
|
||||
{
|
||||
return 1;
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void mm_showchunkinfo(void)
|
||||
{
|
||||
struct mm_allocnode_s *node;
|
||||
int found;
|
||||
|
||||
/* Visit each node in physical memory */
|
||||
|
||||
printf(" CHUNK LIST:\n");
|
||||
|
||||
for (node = g_heapstart;
|
||||
node < g_heapend;
|
||||
node = (struct mm_allocnode_s *)((char*)node + node->size))
|
||||
{
|
||||
printf(" %p 0x%08x 0x%08x %s",
|
||||
node, node->size, node->preceding & ~MM_ALLOC_BIT,
|
||||
node->preceding & MM_ALLOC_BIT ? "Allocated" : "Free ");
|
||||
found = mm_findinfreelist((struct mm_freenode_s *)node);
|
||||
if (found && (node->preceding & MM_ALLOC_BIT) != 0)
|
||||
{
|
||||
printf(" Should NOT have been in free list\n");
|
||||
}
|
||||
else if (!found && (node->preceding & MM_ALLOC_BIT) == 0)
|
||||
{
|
||||
printf(" SHOULD have been in free listT\n");
|
||||
}
|
||||
else
|
||||
{
|
||||
printf(" OK\n");
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void mm_showfreelist(void)
|
||||
{
|
||||
struct mm_freenode_s *prev;
|
||||
struct mm_freenode_s *node;
|
||||
int i = 0;
|
||||
|
||||
printf(" FREE NODE LIST:\n");
|
||||
for(prev = NULL, node = &g_nodelist[0];
|
||||
node;
|
||||
prev = node, node = node->flink)
|
||||
{
|
||||
/* Dump "fake" nodes in a different way */
|
||||
|
||||
if (node->size == 0)
|
||||
{
|
||||
printf(" [NODE %2d] %08x %08x %08x\n",
|
||||
i, node->preceding, (int)node->flink, (int)node->blink);
|
||||
i++;
|
||||
}
|
||||
else
|
||||
{
|
||||
printf(" %08x %08x %08x %08x %08x\n",
|
||||
(int)node, node->size, node->preceding, (int)node->flink, (int)node->blink);
|
||||
}
|
||||
|
||||
/* Verify all backward links */
|
||||
|
||||
if (node->blink != prev)
|
||||
{
|
||||
fprintf(stderr, "Backward link is wrong: Is %p, should be %p\n",
|
||||
node->blink, prev);
|
||||
STOP_ON_ERRORS;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void mm_showmallinfo(void)
|
||||
{
|
||||
int sval;
|
||||
|
||||
mm_showchunkinfo();
|
||||
mm_showfreelist();
|
||||
alloc_info = mallinfo();
|
||||
printf(" mallinfo:\n");
|
||||
printf(" Total space allocated from system = %ld\n",
|
||||
alloc_info.arena);
|
||||
printf(" Number of non-inuse chunks = %ld\n",
|
||||
alloc_info.ordblks);
|
||||
printf(" Largest non-inuse chunk = %ld\n",
|
||||
alloc_info.mxordblk);
|
||||
printf(" Total allocated space = %ld\n",
|
||||
alloc_info.uordblks);
|
||||
printf(" Total non-inuse space = %ld\n",
|
||||
alloc_info.fordblks);
|
||||
|
||||
sval = mm_getsemaphore();
|
||||
if (sval != 1)
|
||||
{
|
||||
fprintf(stderr, "After mallinfo, semaphore count=%d, should be 1\n", sval);
|
||||
STOP_ON_ERRORS;
|
||||
}
|
||||
|
||||
if (!g_adjheapsize)
|
||||
{
|
||||
g_adjheapsize = alloc_info.uordblks + alloc_info.fordblks;
|
||||
if (g_adjheapsize > TEST_HEAP_SIZE + 16 ||
|
||||
g_adjheapsize < TEST_HEAP_SIZE -16)
|
||||
{
|
||||
fprintf(stderr, "Total memory %d not close to uordlbks=%d + fordblks=%d = %d\n",
|
||||
TEST_HEAP_SIZE, g_adjheapsize, alloc_info.uordblks, alloc_info.fordblks, g_adjheapsize);
|
||||
STOP_ON_ERRORS;
|
||||
}
|
||||
}
|
||||
else if (alloc_info.uordblks + alloc_info.fordblks != g_adjheapsize)
|
||||
{
|
||||
fprintf(stderr, "Total memory %d != uordlbks=%d + fordblks=%d\n",
|
||||
g_adjheapsize, alloc_info.uordblks, alloc_info.fordblks);
|
||||
STOP_ON_ERRORS;
|
||||
}
|
||||
}
|
||||
|
||||
static void do_mallocs(void **mem, const int *size, const int *rand, int n)
|
||||
{
|
||||
int sval;
|
||||
int i;
|
||||
int j;
|
||||
|
||||
for (i = 0; i < n; i++)
|
||||
{
|
||||
j = rand[i];
|
||||
if (!mem[j])
|
||||
{
|
||||
printf("(%d)Allocating %d bytes\n", i, size[j]);
|
||||
mem[j] = mm_malloc(size[j]);
|
||||
printf("(%d)Memory allocated at %p\n", i, mem[j]);
|
||||
if (mem[j] == NULL)
|
||||
{
|
||||
int allocsize = MM_ALIGN_UP(size[j] + SIZEOF_MM_ALLOCNODE);
|
||||
fprintf(stderr, "(%d)malloc failed for allocsize=%d\n", i, allocsize);
|
||||
if (allocsize > alloc_info.mxordblk)
|
||||
{
|
||||
fprintf(stderr, " Normal, largest free block is only %ld\n", alloc_info.mxordblk);
|
||||
}
|
||||
else
|
||||
{
|
||||
fprintf(stderr, " ERROR largest free block is %ld\n", alloc_info.mxordblk);
|
||||
exit(1);
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
memset(mem[j], 0xAA, size[j]);
|
||||
}
|
||||
|
||||
sval = mm_getsemaphore();
|
||||
if (sval != 1)
|
||||
{
|
||||
fprintf(stderr, " After malloc semaphore count=%d, should be 1\n", sval);
|
||||
STOP_ON_ERRORS;
|
||||
}
|
||||
|
||||
mm_showmallinfo();
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void do_reallocs(void **mem, const int *oldsize, const int *newsize, const int *rand, int n)
|
||||
{
|
||||
int sval;
|
||||
int i;
|
||||
int j;
|
||||
|
||||
for (i = 0; i < n; i++)
|
||||
{
|
||||
j = rand[i];
|
||||
printf("(%d)Re-allocating at %p from %d to %d bytes\n",
|
||||
i, mem[j], oldsize[j], newsize[j]);
|
||||
mem[j] = mm_realloc(mem[j], newsize[j]);
|
||||
printf("(%d)Memory re-allocated at %p\n", i, mem[j]);
|
||||
if (mem[j] == NULL)
|
||||
{
|
||||
int allocsize = MM_ALIGN_UP(newsize[j] + SIZEOF_MM_ALLOCNODE);
|
||||
fprintf(stderr, "(%d)realloc failed for allocsize=%d\n", i, allocsize);
|
||||
if (allocsize > alloc_info.mxordblk)
|
||||
{
|
||||
fprintf(stderr, " Normal, largest free block is only %ld\n", alloc_info.mxordblk);
|
||||
}
|
||||
else
|
||||
{
|
||||
fprintf(stderr, " ERROR largest free block is %ld\n", alloc_info.mxordblk);
|
||||
exit(1);
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
memset(mem[j], 0x55, newsize[j]);
|
||||
}
|
||||
|
||||
sval = mm_getsemaphore();
|
||||
if (sval != 1)
|
||||
{
|
||||
fprintf(stderr, " After realloc semaphore count=%d, should be 1\n", sval);
|
||||
STOP_ON_ERRORS;
|
||||
}
|
||||
|
||||
mm_showmallinfo();
|
||||
}
|
||||
}
|
||||
|
||||
static void do_memaligns(void **mem, const int *size, const int *align, const int *rand, int n)
|
||||
{
|
||||
int sval;
|
||||
int i;
|
||||
int j;
|
||||
|
||||
for (i = 0; i < n; i++)
|
||||
{
|
||||
j = rand[i];
|
||||
printf("(%d)Allocating %d bytes aligned to 0x%08x\n",
|
||||
i, size[j], align[i]);
|
||||
mem[j] = mm_memalign(align[i], size[j]);
|
||||
printf("(%d)Memory allocated at %p\n", i, mem[j]);
|
||||
if (mem[j] == NULL)
|
||||
{
|
||||
int allocsize = MM_ALIGN_UP(size[j] + SIZEOF_MM_ALLOCNODE) + 2*align[i];
|
||||
fprintf(stderr, "(%d)memalign failed for allocsize=%d\n", i, allocsize);
|
||||
if (allocsize > alloc_info.mxordblk)
|
||||
{
|
||||
fprintf(stderr, " Normal, largest free block is only %ld\n", alloc_info.mxordblk);
|
||||
}
|
||||
else
|
||||
{
|
||||
fprintf(stderr, " ERROR largest free block is %ld\n", alloc_info.mxordblk);
|
||||
exit(1);
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
memset(mem[j], 0x33, size[j]);
|
||||
}
|
||||
|
||||
sval = mm_getsemaphore();
|
||||
if (sval != 1)
|
||||
{
|
||||
fprintf(stderr, " After memalign semaphore count=%d, should be 1\n", sval);
|
||||
STOP_ON_ERRORS;
|
||||
}
|
||||
|
||||
mm_showmallinfo();
|
||||
}
|
||||
}
|
||||
|
||||
static do_frees(void **mem, const int *size, const int *rand, int n)
|
||||
{
|
||||
int sval;
|
||||
int i;
|
||||
int j;
|
||||
|
||||
for (i = 0; i < n; i++)
|
||||
{
|
||||
j = random2[i];
|
||||
printf("(%d)Releasing memory at %p (size=%d bytes)\n",
|
||||
i, mem[j], size[j]);
|
||||
mm_free(mem[j]);
|
||||
mem[j] = NULL;
|
||||
|
||||
sval = mm_getsemaphore();
|
||||
if (sval != 1)
|
||||
{
|
||||
fprintf(stderr, " After free semaphore count=%d, should be 1\n", sval);
|
||||
STOP_ON_ERRORS;
|
||||
}
|
||||
|
||||
mm_showmallinfo();
|
||||
}
|
||||
}
|
||||
|
||||
int main(int argc, char **argv, char **envp)
|
||||
{
|
||||
void *heapbase;
|
||||
int i, j;
|
||||
|
||||
/* Allocate a heap */
|
||||
|
||||
printf("Allocating test heap of %ldKb\n", TEST_HEAP_SIZE/1024);
|
||||
heapbase = malloc(TEST_HEAP_SIZE);
|
||||
printf("Allocated heap_base=%p\n", heap_base);
|
||||
if (heapbase == 0)
|
||||
{
|
||||
fprintf(stderr, "Failed to allocate test heap\n");
|
||||
exit(1);
|
||||
}
|
||||
|
||||
/* Initialize the memory manager */
|
||||
|
||||
mm_initialize(heapbase, TEST_HEAP_SIZE);
|
||||
mm_showmallinfo();
|
||||
|
||||
/* Allocate some memory */
|
||||
|
||||
do_mallocs(allocs, alloc_sizes, random1, NTEST_ALLOCS);
|
||||
|
||||
/* Re-allocate the memory */
|
||||
|
||||
do_reallocs(allocs, alloc_sizes, realloc_sizes, random2, NTEST_ALLOCS);
|
||||
|
||||
/* Release the memory */
|
||||
|
||||
do_frees(allocs, realloc_sizes, random3, NTEST_ALLOCS);
|
||||
|
||||
/* Allocate aligned memory */
|
||||
|
||||
do_memaligns(allocs, alloc_sizes, alignment, random2, NTEST_ALLOCS/2);
|
||||
do_memaligns(allocs, alloc_sizes, alignment, &random2[NTEST_ALLOCS/2], NTEST_ALLOCS/2);
|
||||
|
||||
/* Release aligned memory */
|
||||
|
||||
do_frees(allocs, alloc_sizes, random1, NTEST_ALLOCS);
|
||||
|
||||
/* Clean up and exit */
|
||||
|
||||
free(heapbase);
|
||||
|
||||
printf("TEST COMPLETE\n");
|
||||
return 0;
|
||||
}
|
||||
@@ -0,0 +1,68 @@
|
||||
/************************************************************
|
||||
* mm_zalloc.c
|
||||
*
|
||||
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||
*
|
||||
* 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 Gregory Nutt 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 "mm_environment.h"
|
||||
#include "mm_internal.h"
|
||||
|
||||
/************************************************************
|
||||
* Definitions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Public: Functions
|
||||
************************************************************/
|
||||
|
||||
/************************************************************
|
||||
* Name: zalloc
|
||||
*
|
||||
* Description:
|
||||
* zalloc calls malloc, then zeroes out the allocated chunk.
|
||||
*
|
||||
************************************************************/
|
||||
|
||||
void *zalloc(size_t size)
|
||||
{
|
||||
void *alloc = malloc(size);
|
||||
if (alloc)
|
||||
{
|
||||
memset(alloc, 0, size);
|
||||
}
|
||||
|
||||
return alloc;
|
||||
}
|
||||
Reference in New Issue
Block a user