130 lines
3.7 KiB
C
130 lines
3.7 KiB
C
/*
|
|
* Copyright (c) 2013-2018 Arm Limited. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* 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
|
|
*
|
|
* 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.
|
|
*
|
|
* -----------------------------------------------------------------------------
|
|
*
|
|
* $Revision: V5.1.0
|
|
*
|
|
* Project: CMSIS-RTOS RTX
|
|
* Title: RTX Configuration
|
|
*
|
|
* -----------------------------------------------------------------------------
|
|
*/
|
|
|
|
#include "RTE_Components.h"
|
|
#include "cmsis_compiler.h"
|
|
#include CMSIS_device_header
|
|
#include "hal_sleep.h"
|
|
#include "hal_timer.h"
|
|
#include "hal_trace.h"
|
|
#include "rtx_config.h"
|
|
#include "rtx_os.h"
|
|
|
|
#include "cmsis_os2.h"
|
|
#include "hwtimer_list.h"
|
|
|
|
void WEAK sleep(void) { hal_sleep_enter_sleep(); }
|
|
|
|
extern void rtx_show_all_threads(void);
|
|
#if TASK_HUNG_CHECK_ENABLED
|
|
extern void check_hung_threads(void);
|
|
#endif
|
|
|
|
// OS Idle Thread
|
|
__NO_RETURN void osRtxIdleThread(void *argument) {
|
|
unsigned int os_ticks;
|
|
HWTIMER_ID timer;
|
|
int ret;
|
|
#if defined(DEBUG_SLEEP) && (DEBUG_SLEEP >= 2)
|
|
unsigned int start_time;
|
|
unsigned int start_os_time;
|
|
unsigned int start_tick;
|
|
#endif
|
|
#if !(defined(ROM_BUILD) || defined(PROGRAMMER))
|
|
ret = hal_trace_crash_dump_register(HAL_TRACE_CRASH_DUMP_MODULE_SYS,
|
|
rtx_show_all_threads);
|
|
ASSERT(ret == 0, "IdleTask: Failed to register crash dump callback");
|
|
#endif
|
|
timer = hwtimer_alloc(NULL, NULL);
|
|
ASSERT(timer, "IdleTask: Failed to alloc sleep timer");
|
|
|
|
for (;;) {
|
|
#if TASK_HUNG_CHECK_ENABLED
|
|
check_hung_threads();
|
|
#endif
|
|
|
|
if (hal_sleep_light_sleep() == HAL_SLEEP_STATUS_DEEP) {
|
|
os_ticks = osKernelSuspend();
|
|
if (os_ticks) {
|
|
#if defined(DEBUG_SLEEP) && (DEBUG_SLEEP >= 2)
|
|
__disable_irq();
|
|
#endif
|
|
ret =
|
|
hwtimer_start(timer, MS_TO_HWTICKS(os_ticks * OS_TICK_FREQ / 1000));
|
|
#if defined(DEBUG_SLEEP) && (DEBUG_SLEEP >= 2)
|
|
start_time = hal_sys_timer_get();
|
|
start_tick = SysTick->VAL;
|
|
start_os_time = osRtxInfo.kernel.tick;
|
|
__enable_irq();
|
|
#endif
|
|
if (ret == 0) {
|
|
sleep();
|
|
ret = hwtimer_stop(timer);
|
|
}
|
|
#if defined(DEBUG_SLEEP) && (DEBUG_SLEEP >= 2)
|
|
if (hal_sys_timer_get() - start_time >= MS_TO_HWTICKS(1)) {
|
|
TRACE(5, "[%u/0x%X][%2u/%u] os_idle_demon start timer. tick:%u",
|
|
TICKS_TO_MS(start_time), start_time, start_tick, start_os_time,
|
|
os_ticks);
|
|
}
|
|
#endif
|
|
}
|
|
osKernelResume(os_ticks);
|
|
}
|
|
}
|
|
}
|
|
|
|
// OS Error Callback function
|
|
__WEAK uint32_t osRtxErrorNotify(uint32_t code, void *object_id) {
|
|
(void)object_id;
|
|
|
|
switch (code) {
|
|
case osRtxErrorStackUnderflow:
|
|
// Stack overflow detected for thread (thread_id=object_id)
|
|
break;
|
|
case osRtxErrorISRQueueOverflow:
|
|
// ISR Queue overflow detected when inserting object (object_id)
|
|
break;
|
|
case osRtxErrorTimerQueueOverflow:
|
|
// User Timer Callback Queue overflow detected for timer
|
|
// (timer_id=object_id)
|
|
break;
|
|
case osRtxErrorClibSpace:
|
|
// Standard C/C++ library libspace not available: increase
|
|
// OS_THREAD_LIBSPACE_NUM
|
|
break;
|
|
case osRtxErrorClibMutex:
|
|
// Standard C/C++ library mutex initialization failed
|
|
break;
|
|
default:
|
|
// Reserved
|
|
break;
|
|
}
|
|
ASSERT(0, "osRtxErrorNotify, code: %08x\n", code);
|
|
// return 0U;
|
|
}
|