Diff: rtos/TARGET_CORTEX/mbed_rtos_rtx.c

Revision:

0:38ceb79fef03

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rtos/TARGET_CORTEX/mbed_rtos_rtx.c	Wed Nov 28 15:10:15 2018 +0000
@@ -0,0 +1,71 @@
+/* mbed Microcontroller Library
+ * Copyright (c) 2018-2018 ARM Limited
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *     http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include "cmsis.h"
+#include "mbed_rtx.h"
+#include "mbed_rtos_storage.h"
+#include "cmsis_os2.h"
+#include "mbed_toolchain.h"
+#include "mbed_error.h"
+#include "mbed_critical.h"
+#include "mbed_boot.h"
+
+osThreadAttr_t _main_thread_attr;
+
+#ifndef MBED_CONF_APP_MAIN_STACK_SIZE
+#define MBED_CONF_APP_MAIN_STACK_SIZE MBED_CONF_RTOS_MAIN_THREAD_STACK_SIZE
+#endif
+MBED_ALIGN(8) char _main_stack[MBED_CONF_APP_MAIN_STACK_SIZE];
+mbed_rtos_storage_thread_t _main_obj;
+
+osMutexId_t               singleton_mutex_id;
+mbed_rtos_storage_mutex_t singleton_mutex_obj;
+osMutexAttr_t             singleton_mutex_attr;
+
+void mbed_rtos_init()
+{
+    osKernelInitialize();
+}
+
+MBED_NORETURN void mbed_rtos_start()
+{
+    singleton_mutex_attr.name = "singleton_mutex";
+    singleton_mutex_attr.attr_bits = osMutexRecursive | osMutexPrioInherit | osMutexRobust;
+    singleton_mutex_attr.cb_size = sizeof(singleton_mutex_obj);
+    singleton_mutex_attr.cb_mem = &singleton_mutex_obj;
+
+    _main_thread_attr.stack_mem = _main_stack;
+    _main_thread_attr.stack_size = sizeof(_main_stack);
+    _main_thread_attr.cb_size = sizeof(_main_obj);
+    _main_thread_attr.cb_mem = &_main_obj;
+    _main_thread_attr.priority = osPriorityNormal;
+    _main_thread_attr.name = "main_thread";
+
+    /* Allow non-secure main thread to call secure functions */
+#if defined(DOMAIN_NS) && (DOMAIN_NS == 1U)
+    _main_thread_attr.tz_module = 1U;
+#endif
+
+    singleton_mutex_id = osMutexNew(&singleton_mutex_attr);
+    osThreadId_t result = osThreadNew((osThreadFunc_t)mbed_start, NULL, &_main_thread_attr);
+    if ((void *)result == NULL) {
+        MBED_ERROR1(MBED_MAKE_ERROR(MBED_MODULE_PLATFORM, MBED_ERROR_CODE_INITIALIZATION_FAILED), "Pre main thread not created", &_main_thread_attr);
+    }
+
+    osKernelStart();
+    MBED_ERROR(MBED_MAKE_ERROR(MBED_MODULE_PLATFORM, MBED_ERROR_CODE_INITIALIZATION_FAILED), "Failed to start RTOS");
+    while (1); // Code should never get here
+}