The prosthetic control(MIT)

Committer:
ganlikun
Date:
Thu Jun 23 05:23:34 2022 +0000
Revision:
0:20e0c61e0684
01

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ganlikun 0:20e0c61e0684 1 #include "mbed_stats.h"
ganlikun 0:20e0c61e0684 2 #include <string.h>
ganlikun 0:20e0c61e0684 3 #include <stdlib.h>
ganlikun 0:20e0c61e0684 4 #include "mbed_assert.h"
ganlikun 0:20e0c61e0684 5
ganlikun 0:20e0c61e0684 6 #if MBED_CONF_RTOS_PRESENT
ganlikun 0:20e0c61e0684 7 #include "cmsis_os2.h"
ganlikun 0:20e0c61e0684 8 #endif
ganlikun 0:20e0c61e0684 9
ganlikun 0:20e0c61e0684 10 // note: mbed_stats_heap_get defined in mbed_alloc_wrappers.cpp
ganlikun 0:20e0c61e0684 11
ganlikun 0:20e0c61e0684 12 void mbed_stats_stack_get(mbed_stats_stack_t *stats)
ganlikun 0:20e0c61e0684 13 {
ganlikun 0:20e0c61e0684 14 memset(stats, 0, sizeof(mbed_stats_stack_t));
ganlikun 0:20e0c61e0684 15
ganlikun 0:20e0c61e0684 16 #if MBED_STACK_STATS_ENABLED && MBED_CONF_RTOS_PRESENT
ganlikun 0:20e0c61e0684 17 uint32_t thread_n = osThreadGetCount();
ganlikun 0:20e0c61e0684 18 unsigned i;
ganlikun 0:20e0c61e0684 19 osThreadId_t *threads;
ganlikun 0:20e0c61e0684 20
ganlikun 0:20e0c61e0684 21 threads = malloc(sizeof(osThreadId_t) * thread_n);
ganlikun 0:20e0c61e0684 22 MBED_ASSERT(threads != NULL);
ganlikun 0:20e0c61e0684 23
ganlikun 0:20e0c61e0684 24 osKernelLock();
ganlikun 0:20e0c61e0684 25 thread_n = osThreadEnumerate(threads, thread_n);
ganlikun 0:20e0c61e0684 26
ganlikun 0:20e0c61e0684 27 for(i = 0; i < thread_n; i++) {
ganlikun 0:20e0c61e0684 28 uint32_t stack_size = osThreadGetStackSize(threads[i]);
ganlikun 0:20e0c61e0684 29 stats->max_size += stack_size - osThreadGetStackSpace(threads[i]);
ganlikun 0:20e0c61e0684 30 stats->reserved_size += stack_size;
ganlikun 0:20e0c61e0684 31 stats->stack_cnt++;
ganlikun 0:20e0c61e0684 32 }
ganlikun 0:20e0c61e0684 33 osKernelUnlock();
ganlikun 0:20e0c61e0684 34
ganlikun 0:20e0c61e0684 35 free(threads);
ganlikun 0:20e0c61e0684 36 #endif
ganlikun 0:20e0c61e0684 37 }
ganlikun 0:20e0c61e0684 38
ganlikun 0:20e0c61e0684 39 size_t mbed_stats_stack_get_each(mbed_stats_stack_t *stats, size_t count)
ganlikun 0:20e0c61e0684 40 {
ganlikun 0:20e0c61e0684 41 memset(stats, 0, count*sizeof(mbed_stats_stack_t));
ganlikun 0:20e0c61e0684 42 size_t i = 0;
ganlikun 0:20e0c61e0684 43
ganlikun 0:20e0c61e0684 44 #if MBED_STACK_STATS_ENABLED && MBED_CONF_RTOS_PRESENT
ganlikun 0:20e0c61e0684 45 osThreadId_t *threads;
ganlikun 0:20e0c61e0684 46
ganlikun 0:20e0c61e0684 47 threads = malloc(sizeof(osThreadId_t) * count);
ganlikun 0:20e0c61e0684 48 MBED_ASSERT(threads != NULL);
ganlikun 0:20e0c61e0684 49
ganlikun 0:20e0c61e0684 50 osKernelLock();
ganlikun 0:20e0c61e0684 51 count = osThreadEnumerate(threads, count);
ganlikun 0:20e0c61e0684 52
ganlikun 0:20e0c61e0684 53 for(i = 0; i < count; i++) {
ganlikun 0:20e0c61e0684 54 uint32_t stack_size = osThreadGetStackSize(threads[i]);
ganlikun 0:20e0c61e0684 55 stats[i].max_size = stack_size - osThreadGetStackSpace(threads[i]);
ganlikun 0:20e0c61e0684 56 stats[i].reserved_size = stack_size;
ganlikun 0:20e0c61e0684 57 stats[i].thread_id = (uint32_t)threads[i];
ganlikun 0:20e0c61e0684 58 stats[i].stack_cnt = 1;
ganlikun 0:20e0c61e0684 59 }
ganlikun 0:20e0c61e0684 60 osKernelUnlock();
ganlikun 0:20e0c61e0684 61
ganlikun 0:20e0c61e0684 62 free(threads);
ganlikun 0:20e0c61e0684 63 #endif
ganlikun 0:20e0c61e0684 64
ganlikun 0:20e0c61e0684 65 return i;
ganlikun 0:20e0c61e0684 66 }
ganlikun 0:20e0c61e0684 67
ganlikun 0:20e0c61e0684 68 #if MBED_STACK_STATS_ENABLED && !MBED_CONF_RTOS_PRESENT
ganlikun 0:20e0c61e0684 69 #warning Stack statistics are currently not supported without the rtos.
ganlikun 0:20e0c61e0684 70 #endif
ganlikun 0:20e0c61e0684 71