446 lines
12 KiB
C
446 lines
12 KiB
C
/*----------------------------------------------------------------------------
|
|
* RL-ARM - RTX
|
|
*----------------------------------------------------------------------------
|
|
* Name: RT_SYSTEM.C
|
|
* Purpose: System Task Manager
|
|
* Rev.: V4.60
|
|
*----------------------------------------------------------------------------
|
|
*
|
|
* Copyright (c) 1999-2009 KEIL, 2009-2012 ARM Germany GmbH
|
|
* All rights reserved.
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are met:
|
|
* - Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* - Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* - Neither the name of ARM nor the names of its contributors may be used
|
|
* to endorse or promote products derived from this software without
|
|
* specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE
|
|
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
#include "rt_TypeDef.h"
|
|
#include "RTX_Conf.h"
|
|
#include "rt_Task.h"
|
|
#include "rt_System.h"
|
|
#include "rt_Event.h"
|
|
#include "rt_List.h"
|
|
#include "rt_Mailbox.h"
|
|
#include "rt_Semaphore.h"
|
|
#include "rt_Time.h"
|
|
#include "rt_Robin.h"
|
|
#include "rt_HAL_CM.h"
|
|
|
|
#include "hal_sleep.h"
|
|
#include "hal_timer.h"
|
|
#include "hal_trace.h"
|
|
|
|
extern void sysTimerTick(void);
|
|
extern uint32_t rt_timer_delay_count(void);
|
|
|
|
/*----------------------------------------------------------------------------
|
|
* Global Variables
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
int os_tick_irqn;
|
|
|
|
/*----------------------------------------------------------------------------
|
|
* Local Variables
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
static volatile BIT os_lock;
|
|
static volatile BIT os_psh_flag;
|
|
static U8 pend_flags;
|
|
static U32 systick_lock_tick;
|
|
static U32 systick_lock_ts;
|
|
|
|
/*----------------------------------------------------------------------------
|
|
* Global Functions
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
#if defined (__CC_ARM)
|
|
__asm void $$RTX$$version (void) {
|
|
/* Export a version number symbol for a version control. */
|
|
|
|
EXPORT __RL_RTX_VER
|
|
|
|
__RL_RTX_VER EQU 0x450
|
|
}
|
|
#endif
|
|
|
|
/*--------------------------- rt_suspend ------------------------------------*/
|
|
U32 rt_suspend (void) {
|
|
/* Suspend OS scheduler */
|
|
U32 delta = 0xFFFF;
|
|
U32 start_tick;
|
|
|
|
__disable_irq();
|
|
start_tick = NVIC_ST_CURRENT;
|
|
rt_tsk_lock();
|
|
systick_lock_tick = NVIC_ST_CURRENT;
|
|
systick_lock_ts = hal_sys_timer_get();
|
|
if (start_tick != 0 && (systick_lock_tick == 0 || start_tick < systick_lock_tick)) {
|
|
#if defined(DEBUG_SLEEP) && (DEBUG_SLEEP >= 1)
|
|
TRACE(6,"[%u/0x%X][%2u/%u] rt_suspend corner case: %02u -> %02u",
|
|
TICKS_TO_MS(hal_sys_timer_get()), hal_sys_timer_get(), NVIC_ST_CURRENT, os_time,
|
|
start_tick, systick_lock_tick);
|
|
#endif
|
|
pend_flags |= 1;
|
|
}
|
|
if (pend_flags) {
|
|
delta = 0;
|
|
}
|
|
__enable_irq();
|
|
|
|
if (delta == 0) {
|
|
return 0;
|
|
}
|
|
|
|
if (os_dly.p_dlnk) {
|
|
delta = os_dly.delta_time;
|
|
}
|
|
#ifdef __CMSIS_RTOS
|
|
{
|
|
uint32_t tcnt = rt_timer_delay_count();
|
|
if (tcnt && tcnt < delta) {
|
|
delta = tcnt;
|
|
}
|
|
}
|
|
#else
|
|
if (os_tmr.next) {
|
|
if (os_tmr.tcnt < delta) delta = os_tmr.tcnt;
|
|
}
|
|
#endif
|
|
|
|
return (delta);
|
|
}
|
|
|
|
/*--------------------------- rt_resume -------------------------------------*/
|
|
void rt_resume (U32 sleep_time) {
|
|
/* Resume OS scheduler after suspend */
|
|
//P_TCB next;
|
|
U32 delta;
|
|
U32 resume_ts;
|
|
U32 unlock_ts;
|
|
U32 systick_remain;
|
|
U32 sleep_ticks;
|
|
U8 tick_running = 0;
|
|
const U32 reload = (NVIC_ST_RELOAD + 1);
|
|
|
|
__disable_irq();
|
|
resume_ts = hal_sys_timer_get();
|
|
__enable_irq();
|
|
|
|
sleep_ticks = (resume_ts - systick_lock_ts) * (OS_CLOCK_NOMINAL / CONFIG_SYSTICK_HZ_NOMINAL);
|
|
if (systick_lock_tick == 0) {
|
|
sleep_time = sleep_ticks / reload;
|
|
systick_remain = reload - sleep_ticks % reload;
|
|
} else if (sleep_ticks >= systick_lock_tick) {
|
|
delta = sleep_ticks - systick_lock_tick;
|
|
sleep_time = delta / reload + 1;
|
|
systick_remain = reload - delta % reload;
|
|
} else {
|
|
sleep_time = 0;
|
|
systick_remain = systick_lock_tick - sleep_ticks;
|
|
}
|
|
|
|
if (sleep_time == 0) {
|
|
tick_running = 1;
|
|
goto _task_unlock;
|
|
}
|
|
|
|
// Task switching is allowed in SVC/PENDSV/SYSTICK handlers only
|
|
#if 0
|
|
os_tsk.run->state = READY;
|
|
rt_put_rdy_first (os_tsk.run);
|
|
#endif
|
|
|
|
_inc_sleep_time:
|
|
|
|
os_robin.task = NULL;
|
|
|
|
if (sleep_time) {
|
|
/* Update delays. */
|
|
if (os_dly.p_dlnk) {
|
|
delta = sleep_time;
|
|
if (delta >= os_dly.delta_time) {
|
|
delta -= os_dly.delta_time;
|
|
os_time += os_dly.delta_time;
|
|
os_dly.delta_time = 1;
|
|
while (os_dly.p_dlnk) {
|
|
rt_dec_dly();
|
|
if (delta == 0) break;
|
|
delta--;
|
|
os_time++;
|
|
}
|
|
while (delta) {
|
|
delta--;
|
|
os_time++;
|
|
}
|
|
rt_psh_req();
|
|
} else {
|
|
os_time += delta;
|
|
os_dly.delta_time -= delta;
|
|
}
|
|
} else {
|
|
os_time += sleep_time;
|
|
}
|
|
|
|
os_idle_TCB.rtime += sleep_time;
|
|
#ifdef __CMSIS_RTOS
|
|
delta = sleep_time;
|
|
while (delta && rt_timer_delay_count()) {
|
|
sysTimerTick();
|
|
delta--;
|
|
}
|
|
#else
|
|
/* Check the user timers. */
|
|
if (os_tmr.next) {
|
|
delta = sleep_time;
|
|
if (delta >= os_tmr.tcnt) {
|
|
delta -= os_tmr.tcnt;
|
|
os_tmr.tcnt = 1;
|
|
while (os_tmr.next) {
|
|
rt_tmr_tick();
|
|
if (delta == 0) break;
|
|
delta--;
|
|
}
|
|
} else {
|
|
os_tmr.tcnt -= delta;
|
|
}
|
|
}
|
|
#endif
|
|
} // sleep_time
|
|
|
|
// Task switching is allowed in SVC/PENDSV/SYSTICK handlers only
|
|
#if 0
|
|
/* Switch back to highest ready task */
|
|
next = rt_get_first (&os_rdy);
|
|
rt_switch_req (next);
|
|
#endif
|
|
|
|
#if defined(DEBUG_SLEEP) && (DEBUG_SLEEP >= 1)
|
|
if (sleep_time > 0) {
|
|
TRACE(7,"[%u/0x%X][%2u/%u] rt_resume: sleep_ticks=%u sleep_time=%u systick_remain=%u",
|
|
TICKS_TO_MS(hal_sys_timer_get()), hal_sys_timer_get(), NVIC_ST_CURRENT, os_time,
|
|
sleep_ticks, sleep_time, systick_remain);
|
|
}
|
|
#endif
|
|
|
|
_task_unlock:
|
|
|
|
sleep_time = 0;
|
|
|
|
__disable_irq();
|
|
// Handle corner case: systick counter wraps inside rt_resume()
|
|
unlock_ts = hal_sys_timer_get();
|
|
sleep_ticks = (unlock_ts - resume_ts) * 2;
|
|
// systick_remain value range: [1, reload]
|
|
if (sleep_ticks >= systick_remain) {
|
|
#if defined(DEBUG_SLEEP) && (DEBUG_SLEEP >= 1)
|
|
TRACE(6,"[%u/0x%X][%2u/%u] rt_resume corner case: sleep_ticks=%u systick_remain=%u",
|
|
TICKS_TO_MS(hal_sys_timer_get()), hal_sys_timer_get(), NVIC_ST_CURRENT, os_time,
|
|
sleep_ticks, systick_remain);
|
|
// Update timestamp since traces also consume time
|
|
unlock_ts = hal_sys_timer_get();
|
|
sleep_ticks = (unlock_ts - resume_ts) * (OS_CLOCK_NOMINAL / CONFIG_SYSTICK_HZ_NOMINAL);
|
|
#endif
|
|
delta = sleep_ticks - systick_remain;
|
|
sleep_time = delta / reload + 1;
|
|
systick_remain = reload - delta % reload;
|
|
resume_ts = unlock_ts;
|
|
} else {
|
|
if (tick_running == 0) {
|
|
systick_remain -= sleep_ticks;
|
|
// Adjust systick_remain value range to [0, reload - 1]
|
|
if (systick_remain == reload) {
|
|
systick_remain = 0;
|
|
}
|
|
if (systick_remain) {
|
|
NVIC_ST_RELOAD = systick_remain;
|
|
NVIC_ST_CURRENT = 0;
|
|
while (NVIC_ST_CURRENT == 0);
|
|
NVIC_ST_RELOAD = reload - 1;
|
|
} else {
|
|
NVIC_ST_CURRENT = 0;
|
|
}
|
|
}
|
|
rt_tsk_unlock();
|
|
}
|
|
__enable_irq();
|
|
|
|
if (sleep_time) {
|
|
goto _inc_sleep_time;
|
|
}
|
|
}
|
|
|
|
|
|
/*--------------------------- rt_tsk_lock -----------------------------------*/
|
|
|
|
void rt_tsk_lock (void) {
|
|
/* Prevent task switching by locking out scheduler */
|
|
if (os_tick_irqn < 0) {
|
|
OS_LOCK();
|
|
os_lock = __TRUE;
|
|
OS_UNPEND (&pend_flags);
|
|
} else {
|
|
OS_X_LOCK(os_tick_irqn);
|
|
os_lock = __TRUE;
|
|
OS_X_UNPEND (&pend_flags);
|
|
}
|
|
}
|
|
|
|
|
|
/*--------------------------- rt_tsk_unlock ---------------------------------*/
|
|
|
|
void rt_tsk_unlock (void) {
|
|
/* Unlock scheduler and re-enable task switching */
|
|
if (os_tick_irqn < 0) {
|
|
OS_UNLOCK();
|
|
os_lock = __FALSE;
|
|
OS_PEND (pend_flags, os_psh_flag);
|
|
os_psh_flag = __FALSE;
|
|
} else {
|
|
OS_X_UNLOCK(os_tick_irqn);
|
|
os_lock = __FALSE;
|
|
OS_X_PEND (pend_flags, os_psh_flag);
|
|
os_psh_flag = __FALSE;
|
|
}
|
|
// Allow cpu sleep
|
|
hal_cpu_wake_unlock(HAL_CPU_WAKE_LOCK_USER_RTOS);
|
|
}
|
|
|
|
|
|
/*--------------------------- rt_psh_req ------------------------------------*/
|
|
|
|
void rt_psh_req (void) {
|
|
/* Initiate a post service handling request if required. */
|
|
if (os_lock == __FALSE) {
|
|
OS_PEND_IRQ ();
|
|
}
|
|
else {
|
|
os_psh_flag = __TRUE;
|
|
// Prohibit cpu sleep when an OS service request is enqueued during os lock (rt_suspend)
|
|
hal_cpu_wake_lock(HAL_CPU_WAKE_LOCK_USER_RTOS);
|
|
}
|
|
}
|
|
|
|
|
|
/*--------------------------- rt_pop_req ------------------------------------*/
|
|
|
|
void rt_pop_req (void) {
|
|
/* Process an ISR post service requests. */
|
|
struct OS_XCB *p_CB;
|
|
P_TCB next;
|
|
U32 idx;
|
|
|
|
os_tsk.run->state = READY;
|
|
if (os_tsk.run == &os_idle_TCB) {
|
|
rt_put_rdy_last (os_tsk.run);
|
|
} else {
|
|
rt_put_rdy_first (os_tsk.run);
|
|
}
|
|
|
|
idx = os_psq->last;
|
|
while (os_psq->count) {
|
|
p_CB = os_psq->q[idx].id;
|
|
if (p_CB->cb_type == TCB) {
|
|
/* Is of TCB type */
|
|
rt_evt_psh ((P_TCB)p_CB, (U16)os_psq->q[idx].arg);
|
|
}
|
|
else if (p_CB->cb_type == MCB) {
|
|
/* Is of MCB type */
|
|
rt_mbx_psh ((P_MCB)p_CB, (void *)os_psq->q[idx].arg);
|
|
}
|
|
else {
|
|
/* Must be of SCB type */
|
|
rt_sem_psh ((P_SCB)p_CB);
|
|
}
|
|
if (++idx == os_psq->size) idx = 0;
|
|
rt_dec (&os_psq->count);
|
|
}
|
|
os_psq->last = idx;
|
|
|
|
next = rt_get_first (&os_rdy);
|
|
rt_switch_req (next);
|
|
}
|
|
|
|
|
|
/*--------------------------- os_tick_init ----------------------------------*/
|
|
|
|
__weak int os_tick_init (void) {
|
|
/* Initialize SysTick timer as system tick timer. */
|
|
rt_systick_init ();
|
|
return (-1); /* Return IRQ number of SysTick timer */
|
|
}
|
|
|
|
|
|
/*--------------------------- os_tick_irqack --------------------------------*/
|
|
|
|
__weak void os_tick_irqack (void) {
|
|
/* Acknowledge timer interrupt. */
|
|
}
|
|
|
|
|
|
/*--------------------------- rt_systick ------------------------------------*/
|
|
void rt_systick (void) {
|
|
/* Check for system clock update, suspend running task. */
|
|
P_TCB next;
|
|
|
|
#if __RTX_CPU_STATISTICS__
|
|
os_tsk.run->rtime += 1;
|
|
#endif
|
|
|
|
os_tsk.run->state = READY;
|
|
rt_put_rdy_first (os_tsk.run);
|
|
|
|
/* Check Round Robin timeout. */
|
|
rt_chk_robin ();
|
|
|
|
/* Update delays. */
|
|
os_time++;
|
|
rt_dec_dly ();
|
|
|
|
/* Check the user timers. */
|
|
#ifdef __CMSIS_RTOS
|
|
sysTimerTick();
|
|
#else
|
|
rt_tmr_tick ();
|
|
#endif
|
|
|
|
/* Switch back to highest ready task */
|
|
next = rt_get_first (&os_rdy);
|
|
rt_switch_req (next);
|
|
}
|
|
|
|
/*--------------------------- rt_stk_check ----------------------------------*/
|
|
__weak void rt_stk_check (void) {
|
|
/* Check for stack overflow. */
|
|
if (os_tsk.run->task_id == 0x01) {
|
|
// TODO: For the main thread the check should be done against the main heap pointer
|
|
} else {
|
|
if ((os_tsk.run->tsk_stack < (U32)os_tsk.run->stack) ||
|
|
(os_tsk.run->stack[0] != MAGIC_WORD)) {
|
|
os_error (OS_ERR_STK_OVF);
|
|
}
|
|
}
|
|
}
|
|
|
|
/*----------------------------------------------------------------------------
|
|
* end of file
|
|
*---------------------------------------------------------------------------*/
|
|
|