Weiyu Liu / mbed-rtos

fork

Fork of mbed-rtos by mbed official

rtos/Thread.cpp@84:143955ffb790, 2015-06-17 (annotated)

Committer:
mbed_official
Date:
Wed Jun 17 10:00:10 2015 +0100
Revision:
84:143955ffb790
Parent:
76:85a52b7ef44b
Child:
85:ef0a22cdf839
Synchronized with git revision 7c43e7db007aa7bcb56edfb3324266b1e69747e0



Full URL: https://github.com/mbedmicro/mbed/commit/7c43e7db007aa7bcb56edfb3324266b1e69747e0/



RTOS - Added stack checking methods to Thread

Who changed what in which revision?

UserRevisionLine numberNew contents of line
emilmont 8:88a1a9c26ae3 1 /* mbed Microcontroller Library
emilmont 8:88a1a9c26ae3 2 * Copyright (c) 2006-2012 ARM Limited
emilmont 8:88a1a9c26ae3 3 *
emilmont 8:88a1a9c26ae3 4 * Permission is hereby granted, free of charge, to any person obtaining a copy
emilmont 8:88a1a9c26ae3 5 * of this software and associated documentation files (the "Software"), to deal
emilmont 8:88a1a9c26ae3 6 * in the Software without restriction, including without limitation the rights
emilmont 8:88a1a9c26ae3 7 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
emilmont 8:88a1a9c26ae3 8 * copies of the Software, and to permit persons to whom the Software is
emilmont 8:88a1a9c26ae3 9 * furnished to do so, subject to the following conditions:
emilmont 8:88a1a9c26ae3 10 *
emilmont 8:88a1a9c26ae3 11 * The above copyright notice and this permission notice shall be included in
emilmont 8:88a1a9c26ae3 12 * all copies or substantial portions of the Software.
emilmont 8:88a1a9c26ae3 13 *
emilmont 8:88a1a9c26ae3 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
emilmont 8:88a1a9c26ae3 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
emilmont 8:88a1a9c26ae3 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
emilmont 8:88a1a9c26ae3 17 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
emilmont 8:88a1a9c26ae3 18 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
emilmont 8:88a1a9c26ae3 19 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
emilmont 8:88a1a9c26ae3 20 * SOFTWARE.
emilmont 8:88a1a9c26ae3 21 */
emilmont 8:88a1a9c26ae3 22 #include "Thread.h"
emilmont 8:88a1a9c26ae3 23
mbed_official 40:bd07334df5b1 24 #include "mbed_error.h"
emilmont 8:88a1a9c26ae3 25
emilmont 8:88a1a9c26ae3 26 namespace rtos {
emilmont 8:88a1a9c26ae3 27
emilmont 8:88a1a9c26ae3 28 Thread::Thread(void (*task)(void const *argument), void *argument,
emilmont 8:88a1a9c26ae3 29 osPriority priority, uint32_t stack_size, unsigned char *stack_pointer) {
emilmont 8:88a1a9c26ae3 30 #ifdef CMSIS_OS_RTX
emilmont 8:88a1a9c26ae3 31 _thread_def.pthread = task;
emilmont 8:88a1a9c26ae3 32 _thread_def.tpriority = priority;
emilmont 8:88a1a9c26ae3 33 _thread_def.stacksize = stack_size;
mbed_official 48:e9a2c7cb57a4 34 #ifndef __MBED_CMSIS_RTOS_CA9
emilmont 8:88a1a9c26ae3 35 if (stack_pointer != NULL) {
mbed_official 59:28712e303960 36 _thread_def.stack_pointer = (uint32_t*)stack_pointer;
emilmont 8:88a1a9c26ae3 37 _dynamic_stack = false;
emilmont 8:88a1a9c26ae3 38 } else {
mbed_official 59:28712e303960 39 _thread_def.stack_pointer = new uint32_t[stack_size/sizeof(uint32_t)];
emilmont 8:88a1a9c26ae3 40 if (_thread_def.stack_pointer == NULL)
mbed_official 25:420a92812cd1 41 error("Error allocating the stack memory\n");
emilmont 8:88a1a9c26ae3 42 _dynamic_stack = true;
emilmont 8:88a1a9c26ae3 43 }
mbed_official 84:143955ffb790 44
mbed_official 84:143955ffb790 45 //Fill the stack with a magic word for maximum usage checking
mbed_official 84:143955ffb790 46 for (int i = 0; i < (stack_size / sizeof(uint32_t)); i++) {
mbed_official 84:143955ffb790 47 _thread_def.stack_pointer[i] = 0xE25A2EA5;
mbed_official 84:143955ffb790 48 }
emilmont 8:88a1a9c26ae3 49 #endif
mbed_official 48:e9a2c7cb57a4 50 #endif
emilmont 8:88a1a9c26ae3 51 _tid = osThreadCreate(&_thread_def, argument);
emilmont 8:88a1a9c26ae3 52 }
emilmont 8:88a1a9c26ae3 53
emilmont 8:88a1a9c26ae3 54 osStatus Thread::terminate() {
emilmont 8:88a1a9c26ae3 55 return osThreadTerminate(_tid);
emilmont 8:88a1a9c26ae3 56 }
emilmont 8:88a1a9c26ae3 57
emilmont 8:88a1a9c26ae3 58 osStatus Thread::set_priority(osPriority priority) {
emilmont 8:88a1a9c26ae3 59 return osThreadSetPriority(_tid, priority);
emilmont 8:88a1a9c26ae3 60 }
emilmont 8:88a1a9c26ae3 61
emilmont 8:88a1a9c26ae3 62 osPriority Thread::get_priority() {
emilmont 8:88a1a9c26ae3 63 return osThreadGetPriority(_tid);
emilmont 8:88a1a9c26ae3 64 }
emilmont 8:88a1a9c26ae3 65
emilmont 8:88a1a9c26ae3 66 int32_t Thread::signal_set(int32_t signals) {
emilmont 8:88a1a9c26ae3 67 return osSignalSet(_tid, signals);
emilmont 8:88a1a9c26ae3 68 }
emilmont 8:88a1a9c26ae3 69
mbed_official 76:85a52b7ef44b 70 int32_t Thread::signal_clr(int32_t signals) {
mbed_official 76:85a52b7ef44b 71 return osSignalClear(_tid, signals);
mbed_official 76:85a52b7ef44b 72 }
mbed_official 76:85a52b7ef44b 73
emilmont 8:88a1a9c26ae3 74 Thread::State Thread::get_state() {
mbed_official 48:e9a2c7cb57a4 75 #ifndef __MBED_CMSIS_RTOS_CA9
emilmont 8:88a1a9c26ae3 76 return ((State)_thread_def.tcb.state);
mbed_official 48:e9a2c7cb57a4 77 #else
mbed_official 48:e9a2c7cb57a4 78 uint8_t status;
mbed_official 48:e9a2c7cb57a4 79 status = osThreadGetState(_tid);
mbed_official 48:e9a2c7cb57a4 80 return ((State)status);
mbed_official 48:e9a2c7cb57a4 81 #endif
emilmont 8:88a1a9c26ae3 82 }
emilmont 8:88a1a9c26ae3 83
mbed_official 84:143955ffb790 84 uint32_t Thread::stack_size() {
mbed_official 84:143955ffb790 85 #ifndef __MBED_CMSIS_RTOS_CA9
mbed_official 84:143955ffb790 86 return _thread_def.tcb.priv_stack;
mbed_official 84:143955ffb790 87 #else
mbed_official 84:143955ffb790 88 return 0;
mbed_official 84:143955ffb790 89 #endif
mbed_official 84:143955ffb790 90 }
mbed_official 84:143955ffb790 91
mbed_official 84:143955ffb790 92 uint32_t Thread::free_stack() {
mbed_official 84:143955ffb790 93 #ifndef __MBED_CMSIS_RTOS_CA9
mbed_official 84:143955ffb790 94 uint32_t bottom = (uint32_t)_thread_def.tcb.stack;
mbed_official 84:143955ffb790 95 return _thread_def.tcb.tsk_stack - bottom;
mbed_official 84:143955ffb790 96 #else
mbed_official 84:143955ffb790 97 return 0;
mbed_official 84:143955ffb790 98 #endif
mbed_official 84:143955ffb790 99 }
mbed_official 84:143955ffb790 100
mbed_official 84:143955ffb790 101 uint32_t Thread::used_stack() {
mbed_official 84:143955ffb790 102 #ifndef __MBED_CMSIS_RTOS_CA9
mbed_official 84:143955ffb790 103 uint32_t top = (uint32_t)_thread_def.tcb.stack + _thread_def.tcb.priv_stack;
mbed_official 84:143955ffb790 104 return top - _thread_def.tcb.tsk_stack;
mbed_official 84:143955ffb790 105 #else
mbed_official 84:143955ffb790 106 return 0;
mbed_official 84:143955ffb790 107 #endif
mbed_official 84:143955ffb790 108 }
mbed_official 84:143955ffb790 109
mbed_official 84:143955ffb790 110 uint32_t Thread::max_stack() {
mbed_official 84:143955ffb790 111 #ifndef __MBED_CMSIS_RTOS_CA9
mbed_official 84:143955ffb790 112 uint32_t high_mark = 0;
mbed_official 84:143955ffb790 113 while (_thread_def.tcb.stack[high_mark] == 0xE25A2EA5)
mbed_official 84:143955ffb790 114 high_mark++;
mbed_official 84:143955ffb790 115 return _thread_def.tcb.priv_stack - (high_mark * 4);
mbed_official 84:143955ffb790 116 #else
mbed_official 84:143955ffb790 117 return 0;
mbed_official 84:143955ffb790 118 #endif
mbed_official 84:143955ffb790 119 }
mbed_official 84:143955ffb790 120
emilmont 8:88a1a9c26ae3 121 osEvent Thread::signal_wait(int32_t signals, uint32_t millisec) {
emilmont 8:88a1a9c26ae3 122 return osSignalWait(signals, millisec);
emilmont 8:88a1a9c26ae3 123 }
emilmont 8:88a1a9c26ae3 124
emilmont 8:88a1a9c26ae3 125 osStatus Thread::wait(uint32_t millisec) {
emilmont 8:88a1a9c26ae3 126 return osDelay(millisec);
emilmont 8:88a1a9c26ae3 127 }
emilmont 8:88a1a9c26ae3 128
emilmont 8:88a1a9c26ae3 129 osStatus Thread::yield() {
emilmont 8:88a1a9c26ae3 130 return osThreadYield();
emilmont 8:88a1a9c26ae3 131 }
emilmont 8:88a1a9c26ae3 132
emilmont 8:88a1a9c26ae3 133 osThreadId Thread::gettid() {
emilmont 8:88a1a9c26ae3 134 return osThreadGetId();
emilmont 8:88a1a9c26ae3 135 }
emilmont 8:88a1a9c26ae3 136
emilmont 8:88a1a9c26ae3 137 Thread::~Thread() {
emilmont 8:88a1a9c26ae3 138 terminate();
mbed_official 48:e9a2c7cb57a4 139 #ifndef __MBED_CMSIS_RTOS_CA9
emilmont 8:88a1a9c26ae3 140 if (_dynamic_stack) {
emilmont 8:88a1a9c26ae3 141 delete[] (_thread_def.stack_pointer);
emilmont 8:88a1a9c26ae3 142 }
mbed_official 48:e9a2c7cb57a4 143 #endif
emilmont 8:88a1a9c26ae3 144 }
emilmont 8:88a1a9c26ae3 145
emilmont 8:88a1a9c26ae3 146 }