118 lines
2.3 KiB
C
118 lines
2.3 KiB
C
/*
|
|
* Copyright (c) 2016 Wind River Systems, Inc.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <kernel.h>
|
|
#include <init.h>
|
|
#include <ksched.h>
|
|
#include <wait_q.h>
|
|
#include <misc/__assert.h>
|
|
#include <misc/util.h>
|
|
|
|
void _legacy_sleep(int32_t ticks)
|
|
{
|
|
__ASSERT(!_is_in_isr(), "");
|
|
__ASSERT(ticks != TICKS_UNLIMITED, "");
|
|
|
|
if (ticks <= 0) {
|
|
k_yield();
|
|
return;
|
|
}
|
|
|
|
int key = irq_lock();
|
|
|
|
_remove_thread_from_ready_q(_current);
|
|
_add_thread_timeout(_current, NULL, ticks);
|
|
|
|
_Swap(key);
|
|
}
|
|
|
|
#if (CONFIG_NUM_DYNAMIC_TIMERS > 0)
|
|
|
|
static struct k_timer dynamic_timers[CONFIG_NUM_DYNAMIC_TIMERS];
|
|
static sys_dlist_t timer_pool;
|
|
|
|
static void timer_sem_give(struct k_timer *timer)
|
|
{
|
|
k_sem_give((ksem_t)timer->user_data);
|
|
}
|
|
|
|
static int init_dyamic_timers(struct device *dev)
|
|
{
|
|
ARG_UNUSED(dev);
|
|
|
|
int i;
|
|
int n_timers = ARRAY_SIZE(dynamic_timers);
|
|
|
|
sys_dlist_init(&timer_pool);
|
|
for (i = 0; i < n_timers; i++) {
|
|
k_timer_init(&dynamic_timers[i], timer_sem_give, NULL);
|
|
sys_dlist_append(&timer_pool,
|
|
&dynamic_timers[i].timeout.node);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
SYS_INIT(init_dyamic_timers, PRE_KERNEL_1, CONFIG_KERNEL_INIT_PRIORITY_OBJECTS);
|
|
|
|
ktimer_t task_timer_alloc(void)
|
|
{
|
|
_sched_lock();
|
|
|
|
/*
|
|
* This conversion works only if timeout member
|
|
* variable is the first in time structure.
|
|
*/
|
|
struct k_timer *timer = (struct k_timer *)sys_dlist_get(&timer_pool);
|
|
|
|
k_sched_unlock();
|
|
return timer;
|
|
}
|
|
|
|
void task_timer_free(ktimer_t timer)
|
|
{
|
|
k_timer_stop(timer);
|
|
_sched_lock();
|
|
sys_dlist_append(&timer_pool, &timer->timeout.node);
|
|
k_sched_unlock();
|
|
}
|
|
|
|
void task_timer_start(ktimer_t timer, int32_t duration,
|
|
int32_t period, ksem_t sema)
|
|
{
|
|
if (duration < 0 || period < 0 || (duration == 0 && period == 0)) {
|
|
k_timer_stop(timer);
|
|
return;
|
|
}
|
|
|
|
timer->user_data = (void *)sema;
|
|
|
|
k_timer_start(timer, _ticks_to_ms(duration), _ticks_to_ms(period));
|
|
}
|
|
|
|
bool _timer_pool_is_empty(void)
|
|
{
|
|
_sched_lock();
|
|
|
|
bool is_empty = sys_dlist_is_empty(&timer_pool);
|
|
|
|
k_sched_unlock();
|
|
return is_empty;
|
|
}
|
|
|
|
#endif /* (CONFIG_NUM_DYNAMIC_TIMERS > 0) */
|
|
|
|
void *nano_timer_test(struct nano_timer *timer, int32_t timeout_in_ticks)
|
|
{
|
|
uint32_t (*test_fn)(struct k_timer *timer);
|
|
|
|
if (timeout_in_ticks == TICKS_NONE) {
|
|
test_fn = k_timer_status_get;
|
|
} else {
|
|
test_fn = k_timer_status_sync;
|
|
}
|
|
return test_fn(timer) ? (void *)timer->user_data : NULL;
|
|
}
|