267 lines
6.2 KiB
C
267 lines
6.2 KiB
C
/*
|
|
* Copyright (c) 2006-2021, RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
* 2006-03-23 Bernard the first version
|
|
* 2010-11-10 Bernard add cleanup callback function in thread exit.
|
|
* 2012-12-29 Bernard fix compiling warning.
|
|
* 2013-12-21 Grissiom let rt_thread_idle_excute loop until there is no
|
|
* dead thread.
|
|
* 2016-08-09 ArdaFu add method to get the handler of the idle thread.
|
|
* 2018-02-07 Bernard lock scheduler to protect tid->cleanup.
|
|
* 2018-07-14 armink add idle hook list
|
|
* 2018-11-22 Jesven add per cpu idle task
|
|
* combine the code of primary and secondary cpu
|
|
*/
|
|
|
|
#include <rthw.h>
|
|
#include <rtthread.h>
|
|
|
|
#ifdef RT_USING_MODULE
|
|
#include <dlmodule.h>
|
|
#endif
|
|
|
|
#if defined (RT_USING_HOOK)
|
|
#ifndef RT_USING_IDLE_HOOK
|
|
#define RT_USING_IDLE_HOOK
|
|
#endif
|
|
#endif
|
|
|
|
#ifndef IDLE_THREAD_STACK_SIZE
|
|
#if defined (RT_USING_IDLE_HOOK) || defined(RT_USING_HEAP)
|
|
#define IDLE_THREAD_STACK_SIZE 256
|
|
#else
|
|
#define IDLE_THREAD_STACK_SIZE 128
|
|
#endif
|
|
#endif
|
|
|
|
#ifdef RT_USING_SMP
|
|
#define _CPUS_NR RT_CPUS_NR
|
|
#else
|
|
#define _CPUS_NR 1
|
|
#endif
|
|
|
|
extern rt_list_t rt_thread_defunct;
|
|
|
|
static struct rt_thread idle[_CPUS_NR];
|
|
ALIGN(RT_ALIGN_SIZE)
|
|
static rt_uint8_t rt_thread_stack[_CPUS_NR][IDLE_THREAD_STACK_SIZE];
|
|
|
|
#ifdef RT_USING_IDLE_HOOK
|
|
#ifndef RT_IDLE_HOOK_LIST_SIZE
|
|
#define RT_IDLE_HOOK_LIST_SIZE 4
|
|
#endif
|
|
|
|
static void (*idle_hook_list[RT_IDLE_HOOK_LIST_SIZE])(void);
|
|
|
|
/**
|
|
* @ingroup Hook
|
|
* This function sets a hook function to idle thread loop. When the system performs
|
|
* idle loop, this hook function should be invoked.
|
|
*
|
|
* @param hook the specified hook function
|
|
*
|
|
* @return RT_EOK: set OK
|
|
* -RT_EFULL: hook list is full
|
|
*
|
|
* @note the hook function must be simple and never be blocked or suspend.
|
|
*/
|
|
rt_err_t rt_thread_idle_sethook(void (*hook)(void))
|
|
{
|
|
rt_size_t i;
|
|
rt_base_t level;
|
|
rt_err_t ret = -RT_EFULL;
|
|
|
|
/* disable interrupt */
|
|
level = rt_hw_interrupt_disable();
|
|
|
|
for (i = 0; i < RT_IDLE_HOOK_LIST_SIZE; i++)
|
|
{
|
|
if (idle_hook_list[i] == RT_NULL)
|
|
{
|
|
idle_hook_list[i] = hook;
|
|
ret = RT_EOK;
|
|
break;
|
|
}
|
|
}
|
|
/* enable interrupt */
|
|
rt_hw_interrupt_enable(level);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* delete the idle hook on hook list
|
|
*
|
|
* @param hook the specified hook function
|
|
*
|
|
* @return RT_EOK: delete OK
|
|
* -RT_ENOSYS: hook was not found
|
|
*/
|
|
rt_err_t rt_thread_idle_delhook(void (*hook)(void))
|
|
{
|
|
rt_size_t i;
|
|
rt_base_t level;
|
|
rt_err_t ret = -RT_ENOSYS;
|
|
|
|
/* disable interrupt */
|
|
level = rt_hw_interrupt_disable();
|
|
|
|
for (i = 0; i < RT_IDLE_HOOK_LIST_SIZE; i++)
|
|
{
|
|
if (idle_hook_list[i] == hook)
|
|
{
|
|
idle_hook_list[i] = RT_NULL;
|
|
ret = RT_EOK;
|
|
break;
|
|
}
|
|
}
|
|
/* enable interrupt */
|
|
rt_hw_interrupt_enable(level);
|
|
|
|
return ret;
|
|
}
|
|
|
|
#endif
|
|
|
|
/* Return whether there is defunctional thread to be deleted. */
|
|
rt_inline int _has_defunct_thread(void)
|
|
{
|
|
/* The rt_list_isempty has prototype of "int rt_list_isempty(const rt_list_t *l)".
|
|
* So the compiler has a good reason that the rt_thread_defunct list does
|
|
* not change within rt_thread_idle_excute thus optimize the "while" loop
|
|
* into a "if".
|
|
*
|
|
* So add the volatile qualifier here. */
|
|
const volatile rt_list_t *l = (const volatile rt_list_t *)&rt_thread_defunct;
|
|
|
|
return l->next != l;
|
|
}
|
|
|
|
/**
|
|
* @ingroup Thread
|
|
*
|
|
* This function will perform system background job when system idle.
|
|
*/
|
|
void rt_thread_idle_excute(void)
|
|
{
|
|
/* Loop until there is no dead thread. So one call to rt_thread_idle_excute
|
|
* will do all the cleanups. */
|
|
/* disable interrupt */
|
|
|
|
RT_DEBUG_NOT_IN_INTERRUPT;
|
|
|
|
#ifdef RT_USING_HEAP
|
|
while (1)
|
|
{
|
|
rt_base_t lock;
|
|
rt_thread_t thread;
|
|
|
|
lock = rt_hw_interrupt_disable();
|
|
|
|
/* check whether list is empty */
|
|
if (!_has_defunct_thread())
|
|
{
|
|
rt_hw_interrupt_enable(lock);
|
|
break;
|
|
}
|
|
/* get defunct thread */
|
|
thread = rt_list_entry(rt_thread_defunct.next,
|
|
struct rt_thread,
|
|
tlist);
|
|
/* remove defunct thread */
|
|
rt_list_remove(&(thread->tlist));
|
|
/* release thread's stack */
|
|
RT_KERNEL_FREE(thread->stack_addr);
|
|
/* delete thread object */
|
|
rt_object_delete((rt_object_t)thread);
|
|
rt_hw_interrupt_enable(lock);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
extern void rt_system_power_manager(void);
|
|
static void rt_thread_idle_entry(void *parameter)
|
|
{
|
|
#ifdef RT_USING_SMP
|
|
if (rt_hw_cpu_id() != 0)
|
|
{
|
|
while (1)
|
|
{
|
|
rt_hw_secondary_cpu_idle_exec();
|
|
}
|
|
}
|
|
#endif
|
|
|
|
while (1)
|
|
{
|
|
#ifdef RT_USING_IDLE_HOOK
|
|
rt_size_t i;
|
|
|
|
for (i = 0; i < RT_IDLE_HOOK_LIST_SIZE; i++)
|
|
{
|
|
if (idle_hook_list[i] != RT_NULL)
|
|
{
|
|
idle_hook_list[i]();
|
|
}
|
|
}
|
|
#endif
|
|
|
|
rt_thread_idle_excute();
|
|
#ifdef RT_USING_PM
|
|
rt_system_power_manager();
|
|
#endif
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @ingroup SystemInit
|
|
*
|
|
* This function will initialize idle thread, then start it.
|
|
*
|
|
* @note this function must be invoked when system init.
|
|
*/
|
|
void rt_thread_idle_init(void)
|
|
{
|
|
rt_ubase_t i;
|
|
char tidle_name[RT_NAME_MAX];
|
|
|
|
for (i = 0; i < _CPUS_NR; i++)
|
|
{
|
|
rt_sprintf(tidle_name, "tidle%d", i);
|
|
rt_thread_init(&idle[i],
|
|
tidle_name,
|
|
rt_thread_idle_entry,
|
|
RT_NULL,
|
|
&rt_thread_stack[i][0],
|
|
sizeof(rt_thread_stack[i]),
|
|
RT_THREAD_PRIORITY_MAX - 1,
|
|
32);
|
|
#ifdef RT_USING_SMP
|
|
rt_thread_control(&idle[i], RT_THREAD_CTRL_BIND_CPU, (void*)i);
|
|
#endif
|
|
/* startup */
|
|
rt_thread_startup(&idle[i]);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @ingroup Thread
|
|
*
|
|
* This function will get the handler of the idle thread.
|
|
*
|
|
*/
|
|
rt_thread_t rt_thread_idle_gethandler(void)
|
|
{
|
|
#ifdef RT_USING_SMP
|
|
register int id = rt_hw_cpu_id();
|
|
#else
|
|
register int id = 0;
|
|
#endif
|
|
|
|
return (rt_thread_t)(&idle[id]);
|
|
}
|