Jonathon Fletcher / rtx

in OS_TSK, rename run as tsk_run and new as tsk_new.

rt_MemBox.c@0:5f46ebd8588e, 2012-09-02 (annotated)

Committer:
jonathonfletcher
Date:
Sun Sep 02 03:24:20 2012 +0000
Revision:
0:5f46ebd8588e
in OS_TSK, rename run as tsk_run and new as tsk_new.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jonathonfletcher 0:5f46ebd8588e 1 /*----------------------------------------------------------------------------
jonathonfletcher 0:5f46ebd8588e 2 * RL-ARM - RTX
jonathonfletcher 0:5f46ebd8588e 3 *----------------------------------------------------------------------------
jonathonfletcher 0:5f46ebd8588e 4 * Name: RT_MEMBOX.C
jonathonfletcher 0:5f46ebd8588e 5 * Purpose: Interface functions for fixed memory block management system
jonathonfletcher 0:5f46ebd8588e 6 * Rev.: V4.50
jonathonfletcher 0:5f46ebd8588e 7 *----------------------------------------------------------------------------
jonathonfletcher 0:5f46ebd8588e 8 *
jonathonfletcher 0:5f46ebd8588e 9 * Copyright (c) 1999-2009 KEIL, 2009-2012 ARM Germany GmbH
jonathonfletcher 0:5f46ebd8588e 10 * All rights reserved.
jonathonfletcher 0:5f46ebd8588e 11 * Redistribution and use in source and binary forms, with or without
jonathonfletcher 0:5f46ebd8588e 12 * modification, are permitted provided that the following conditions are met:
jonathonfletcher 0:5f46ebd8588e 13 * - Redistributions of source code must retain the above copyright
jonathonfletcher 0:5f46ebd8588e 14 * notice, this list of conditions and the following disclaimer.
jonathonfletcher 0:5f46ebd8588e 15 * - Redistributions in binary form must reproduce the above copyright
jonathonfletcher 0:5f46ebd8588e 16 * notice, this list of conditions and the following disclaimer in the
jonathonfletcher 0:5f46ebd8588e 17 * documentation and/or other materials provided with the distribution.
jonathonfletcher 0:5f46ebd8588e 18 * - Neither the name of ARM nor the names of its contributors may be used
jonathonfletcher 0:5f46ebd8588e 19 * to endorse or promote products derived from this software without
jonathonfletcher 0:5f46ebd8588e 20 * specific prior written permission.
jonathonfletcher 0:5f46ebd8588e 21 *
jonathonfletcher 0:5f46ebd8588e 22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
jonathonfletcher 0:5f46ebd8588e 23 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
jonathonfletcher 0:5f46ebd8588e 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
jonathonfletcher 0:5f46ebd8588e 25 * ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE
jonathonfletcher 0:5f46ebd8588e 26 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
jonathonfletcher 0:5f46ebd8588e 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
jonathonfletcher 0:5f46ebd8588e 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
jonathonfletcher 0:5f46ebd8588e 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
jonathonfletcher 0:5f46ebd8588e 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
jonathonfletcher 0:5f46ebd8588e 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
jonathonfletcher 0:5f46ebd8588e 32 * POSSIBILITY OF SUCH DAMAGE.
jonathonfletcher 0:5f46ebd8588e 33 *---------------------------------------------------------------------------*/
jonathonfletcher 0:5f46ebd8588e 34
jonathonfletcher 0:5f46ebd8588e 35 #include "rt_TypeDef.h"
jonathonfletcher 0:5f46ebd8588e 36 #include "RTX_Config.h"
jonathonfletcher 0:5f46ebd8588e 37 #include "rt_System.h"
jonathonfletcher 0:5f46ebd8588e 38 #include "rt_MemBox.h"
jonathonfletcher 0:5f46ebd8588e 39 #include "rt_HAL_CM.h"
jonathonfletcher 0:5f46ebd8588e 40
jonathonfletcher 0:5f46ebd8588e 41 /*----------------------------------------------------------------------------
jonathonfletcher 0:5f46ebd8588e 42 * Global Functions
jonathonfletcher 0:5f46ebd8588e 43 *---------------------------------------------------------------------------*/
jonathonfletcher 0:5f46ebd8588e 44
jonathonfletcher 0:5f46ebd8588e 45
jonathonfletcher 0:5f46ebd8588e 46 /*--------------------------- _init_box -------------------------------------*/
jonathonfletcher 0:5f46ebd8588e 47
jonathonfletcher 0:5f46ebd8588e 48 int _init_box (void *box_mem, U32 box_size, U32 blk_size) {
jonathonfletcher 0:5f46ebd8588e 49 /* Initialize memory block system, returns 0 if OK, 1 if fails. */
jonathonfletcher 0:5f46ebd8588e 50 void *end;
jonathonfletcher 0:5f46ebd8588e 51 void *blk;
jonathonfletcher 0:5f46ebd8588e 52 void *next;
jonathonfletcher 0:5f46ebd8588e 53 U32 sizeof_bm;
jonathonfletcher 0:5f46ebd8588e 54
jonathonfletcher 0:5f46ebd8588e 55 /* Create memory structure. */
jonathonfletcher 0:5f46ebd8588e 56 if (blk_size & BOX_ALIGN_8) {
jonathonfletcher 0:5f46ebd8588e 57 /* Memory blocks 8-byte aligned. */
jonathonfletcher 0:5f46ebd8588e 58 blk_size = ((blk_size & ~BOX_ALIGN_8) + 7) & ~7;
jonathonfletcher 0:5f46ebd8588e 59 sizeof_bm = (sizeof (struct OS_BM) + 7) & ~7;
jonathonfletcher 0:5f46ebd8588e 60 }
jonathonfletcher 0:5f46ebd8588e 61 else {
jonathonfletcher 0:5f46ebd8588e 62 /* Memory blocks 4-byte aligned. */
jonathonfletcher 0:5f46ebd8588e 63 blk_size = (blk_size + 3) & ~3;
jonathonfletcher 0:5f46ebd8588e 64 sizeof_bm = sizeof (struct OS_BM);
jonathonfletcher 0:5f46ebd8588e 65 }
jonathonfletcher 0:5f46ebd8588e 66 if (blk_size == 0) {
jonathonfletcher 0:5f46ebd8588e 67 return (1);
jonathonfletcher 0:5f46ebd8588e 68 }
jonathonfletcher 0:5f46ebd8588e 69 if ((blk_size + sizeof_bm) > box_size) {
jonathonfletcher 0:5f46ebd8588e 70 return (1);
jonathonfletcher 0:5f46ebd8588e 71 }
jonathonfletcher 0:5f46ebd8588e 72 /* Create a Memory structure. */
jonathonfletcher 0:5f46ebd8588e 73 blk = ((U8 *) box_mem) + sizeof_bm;
jonathonfletcher 0:5f46ebd8588e 74 ((P_BM) box_mem)->free = blk;
jonathonfletcher 0:5f46ebd8588e 75 end = ((U8 *) box_mem) + box_size;
jonathonfletcher 0:5f46ebd8588e 76 ((P_BM) box_mem)->end = end;
jonathonfletcher 0:5f46ebd8588e 77 ((P_BM) box_mem)->blk_size = blk_size;
jonathonfletcher 0:5f46ebd8588e 78
jonathonfletcher 0:5f46ebd8588e 79 /* Link all free blocks using offsets. */
jonathonfletcher 0:5f46ebd8588e 80 end = ((U8 *) end) - blk_size;
jonathonfletcher 0:5f46ebd8588e 81 while (1) {
jonathonfletcher 0:5f46ebd8588e 82 next = ((U8 *) blk) + blk_size;
jonathonfletcher 0:5f46ebd8588e 83 if (next > end) break;
jonathonfletcher 0:5f46ebd8588e 84 *((void **)blk) = next;
jonathonfletcher 0:5f46ebd8588e 85 blk = next;
jonathonfletcher 0:5f46ebd8588e 86 }
jonathonfletcher 0:5f46ebd8588e 87 /* end marker */
jonathonfletcher 0:5f46ebd8588e 88 *((void **)blk) = 0;
jonathonfletcher 0:5f46ebd8588e 89 return (0);
jonathonfletcher 0:5f46ebd8588e 90 }
jonathonfletcher 0:5f46ebd8588e 91
jonathonfletcher 0:5f46ebd8588e 92 /*--------------------------- rt_alloc_box ----------------------------------*/
jonathonfletcher 0:5f46ebd8588e 93
jonathonfletcher 0:5f46ebd8588e 94 void *rt_alloc_box (void *box_mem) {
jonathonfletcher 0:5f46ebd8588e 95 /* Allocate a memory block and return start address. */
jonathonfletcher 0:5f46ebd8588e 96 void **free;
jonathonfletcher 0:5f46ebd8588e 97 #ifndef __USE_EXCLUSIVE_ACCESS
jonathonfletcher 0:5f46ebd8588e 98 int irq_dis;
jonathonfletcher 0:5f46ebd8588e 99
jonathonfletcher 0:5f46ebd8588e 100 irq_dis = __disable_irq ();
jonathonfletcher 0:5f46ebd8588e 101 free = ((P_BM) box_mem)->free;
jonathonfletcher 0:5f46ebd8588e 102 if (free) {
jonathonfletcher 0:5f46ebd8588e 103 ((P_BM) box_mem)->free = *free;
jonathonfletcher 0:5f46ebd8588e 104 }
jonathonfletcher 0:5f46ebd8588e 105 if (!irq_dis) __enable_irq ();
jonathonfletcher 0:5f46ebd8588e 106 #else
jonathonfletcher 0:5f46ebd8588e 107 do {
jonathonfletcher 0:5f46ebd8588e 108 if ((free = (void **)__ldrex(&((P_BM) box_mem)->free)) == 0) {
jonathonfletcher 0:5f46ebd8588e 109 __clrex();
jonathonfletcher 0:5f46ebd8588e 110 break;
jonathonfletcher 0:5f46ebd8588e 111 }
jonathonfletcher 0:5f46ebd8588e 112 } while (__strex((U32)*free, &((P_BM) box_mem)->free));
jonathonfletcher 0:5f46ebd8588e 113 #endif
jonathonfletcher 0:5f46ebd8588e 114 return (free);
jonathonfletcher 0:5f46ebd8588e 115 }
jonathonfletcher 0:5f46ebd8588e 116
jonathonfletcher 0:5f46ebd8588e 117
jonathonfletcher 0:5f46ebd8588e 118 /*--------------------------- _calloc_box -----------------------------------*/
jonathonfletcher 0:5f46ebd8588e 119
jonathonfletcher 0:5f46ebd8588e 120 void *_calloc_box (void *box_mem) {
jonathonfletcher 0:5f46ebd8588e 121 /* Allocate a 0-initialized memory block and return start address. */
jonathonfletcher 0:5f46ebd8588e 122 void *free;
jonathonfletcher 0:5f46ebd8588e 123 U32 *p;
jonathonfletcher 0:5f46ebd8588e 124 U32 i;
jonathonfletcher 0:5f46ebd8588e 125
jonathonfletcher 0:5f46ebd8588e 126 free = _alloc_box (box_mem);
jonathonfletcher 0:5f46ebd8588e 127 if (free) {
jonathonfletcher 0:5f46ebd8588e 128 p = free;
jonathonfletcher 0:5f46ebd8588e 129 for (i = ((P_BM) box_mem)->blk_size; i; i -= 4) {
jonathonfletcher 0:5f46ebd8588e 130 *p = 0;
jonathonfletcher 0:5f46ebd8588e 131 p++;
jonathonfletcher 0:5f46ebd8588e 132 }
jonathonfletcher 0:5f46ebd8588e 133 }
jonathonfletcher 0:5f46ebd8588e 134 return (free);
jonathonfletcher 0:5f46ebd8588e 135 }
jonathonfletcher 0:5f46ebd8588e 136
jonathonfletcher 0:5f46ebd8588e 137
jonathonfletcher 0:5f46ebd8588e 138 /*--------------------------- rt_free_box -----------------------------------*/
jonathonfletcher 0:5f46ebd8588e 139
jonathonfletcher 0:5f46ebd8588e 140 int rt_free_box (void *box_mem, void *box) {
jonathonfletcher 0:5f46ebd8588e 141 /* Free a memory block, returns 0 if OK, 1 if box does not belong to box_mem */
jonathonfletcher 0:5f46ebd8588e 142 #ifndef __USE_EXCLUSIVE_ACCESS
jonathonfletcher 0:5f46ebd8588e 143 int irq_dis;
jonathonfletcher 0:5f46ebd8588e 144 #endif
jonathonfletcher 0:5f46ebd8588e 145
jonathonfletcher 0:5f46ebd8588e 146 if (box < box_mem || box >= ((P_BM) box_mem)->end) {
jonathonfletcher 0:5f46ebd8588e 147 return (1);
jonathonfletcher 0:5f46ebd8588e 148 }
jonathonfletcher 0:5f46ebd8588e 149
jonathonfletcher 0:5f46ebd8588e 150 #ifndef __USE_EXCLUSIVE_ACCESS
jonathonfletcher 0:5f46ebd8588e 151 irq_dis = __disable_irq ();
jonathonfletcher 0:5f46ebd8588e 152 *((void **)box) = ((P_BM) box_mem)->free;
jonathonfletcher 0:5f46ebd8588e 153 ((P_BM) box_mem)->free = box;
jonathonfletcher 0:5f46ebd8588e 154 if (!irq_dis) __enable_irq ();
jonathonfletcher 0:5f46ebd8588e 155 #else
jonathonfletcher 0:5f46ebd8588e 156 do {
jonathonfletcher 0:5f46ebd8588e 157 *((void **)box) = (void *)__ldrex(&((P_BM) box_mem)->free);
jonathonfletcher 0:5f46ebd8588e 158 } while (__strex ((U32)box, &((P_BM) box_mem)->free));
jonathonfletcher 0:5f46ebd8588e 159 #endif
jonathonfletcher 0:5f46ebd8588e 160 return (0);
jonathonfletcher 0:5f46ebd8588e 161 }
jonathonfletcher 0:5f46ebd8588e 162
jonathonfletcher 0:5f46ebd8588e 163 /*----------------------------------------------------------------------------
jonathonfletcher 0:5f46ebd8588e 164 * end of file
jonathonfletcher 0:5f46ebd8588e 165 *---------------------------------------------------------------------------*/
jonathonfletcher 0:5f46ebd8588e 166