aboutsummaryrefslogtreecommitdiffstats
path: root/os/kernel/src/chmemcore.c
blob: 435120a33b57a5fad95abba386ba21c0e944694d (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
/*
    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010 Giovanni Di Sirio.

    This file is part of ChibiOS/RT.

    ChibiOS/RT is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 3 of the License, or
    (at your option) any later version.

    ChibiOS/RT is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program.  If not, see <http://www.gnu.org/licenses/>.
*/

/**
 * @file    chmemcore.c
 * @brief   Core memory manager code.
 *
 * @addtogroup memcore
 * @{
 */

#include "ch.h"

#if CH_USE_MEMCORE

static uint8_t *nextmem;
static uint8_t *endmem;

/**
 * @brief   Low level memory manager initialization.
 * @note    Internal use only.
 */
void core_init(void) {
#if CH_MEMCORE_SIZE == 0
  extern uint8_t __heap_base__;
  extern uint8_t __heap_end__;
  nextmem = &__heap_base__;
  endmem = &__heap_end__;
#else
  static stkalign_t buffer[MEM_ALIGN_SIZE(CH_MEMCORE_SIZE) /
                           sizeof(stkalign_t)];
  nextmem = (uint8_t *)&buffer[0];
  endmem = (uint8_t *)&buffer[MEM_ALIGN_SIZE(CH_MEMCORE_SIZE) /
                              sizeof(stkalign_t)];
#endif
}

/**
 * @brief   Allocates a memory block.
 * @details The size of the returned block is aligned to the alignment
 *          type @p stkalign_t so it is not possible to allocate less
 *          than <code>sizeof(stkalign_t)</code>.
 *
 *
 * @param[in] size      the size of the block to be allocated
 * @return              A pointer to the allocated memory block.
 * @retval NULL         allocation failed, core memory exhausted.
 */
void *chCoreAlloc(size_t size) {
  void *p;

  chSysLock();
  p = chCoreAllocI(size);
  chSysUnlock();
  return p;
}

/**
 * @brief   Allocates a memory block.
 * @details The size of the returned block is aligned to the alignment
 *          type @p align_t so it is not possible to allocate less than
 *          <code>sizeof(align_t)</code>.
 *
 * @param[in] size      the size of the block to be allocated.
 * @return              A pointer to the allocated memory block.
 * @retval NULL         allocation failed, core memory exhausted.
 */
void *chCoreAllocI(size_t size) {
  void *p;

  size = MEM_ALIGN_SIZE(size);
  if ((size_t)(endmem - nextmem) < size)
    return NULL;
  p = nextmem;
  nextmem += size;
  return p;
}

/**
 * @brief   Core memory left.
 *
 * @return              The size, in bytes, of the free core memory.
 */
size_t chCoreFree(void) {

  return (size_t)(endmem - nextmem);
}
#endif /* CH_USE_MEMCORE */

/** @} */