PES4 / Mbed OS Queue_02
Committer:
demayer
Date:
Sat Mar 28 15:28:19 2020 +0000
Revision:
0:6bf0743ece18
IMU Thread with an event-queue running parallel to handle tasks like a 5 times blinking LED. Button with interrupt detected.

Who changed what in which revision?

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