107 lines
2.4 KiB
C
107 lines
2.4 KiB
C
/*
|
|
* Copyright (c) 2015 Wind River Systems, Inc.
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
/**
|
|
* @file
|
|
* @brief Nanokernel sleep routines
|
|
*
|
|
* This module provides various nanokernel related sleep routines.
|
|
*/
|
|
|
|
#include <nano_private.h>
|
|
#include <nano_internal.h>
|
|
#include <toolchain.h>
|
|
#include <sections.h>
|
|
#include <wait_q.h>
|
|
|
|
void fiber_sleep(int32_t timeout_in_ticks)
|
|
{
|
|
int key;
|
|
|
|
if (timeout_in_ticks == TICKS_NONE) {
|
|
fiber_yield();
|
|
return;
|
|
}
|
|
|
|
key = irq_lock();
|
|
_nano_timeout_add(_nanokernel.current, NULL, timeout_in_ticks);
|
|
_Swap(key);
|
|
}
|
|
|
|
FUNC_ALIAS(_fiber_wakeup, isr_fiber_wakeup, void);
|
|
FUNC_ALIAS(_fiber_wakeup, fiber_fiber_wakeup, void);
|
|
|
|
void _fiber_wakeup(nano_thread_id_t fiber)
|
|
{
|
|
int key = irq_lock();
|
|
|
|
/* verify first if fiber is not waiting on an object */
|
|
if (!fiber->nano_timeout.wait_q && (_nano_timeout_abort(fiber) == 0)) {
|
|
_nano_fiber_ready(fiber);
|
|
}
|
|
|
|
irq_unlock(key);
|
|
}
|
|
|
|
void task_fiber_wakeup(nano_thread_id_t fiber)
|
|
{
|
|
int key = irq_lock();
|
|
|
|
/* verify first if fiber is not waiting on an object */
|
|
if ((fiber->nano_timeout.wait_q) || (_nano_timeout_abort(fiber) < 0)) {
|
|
irq_unlock(key);
|
|
} else {
|
|
_nano_fiber_ready(fiber);
|
|
_Swap(key);
|
|
}
|
|
}
|
|
|
|
void fiber_wakeup(nano_thread_id_t fiber)
|
|
{
|
|
static void (*func[3])(nano_thread_id_t) = {
|
|
isr_fiber_wakeup,
|
|
fiber_fiber_wakeup,
|
|
task_fiber_wakeup
|
|
};
|
|
|
|
func[sys_execution_context_type_get()](fiber);
|
|
}
|
|
|
|
#ifndef CONFIG_MICROKERNEL
|
|
FUNC_ALIAS(_nano_task_sleep, task_sleep, void);
|
|
#endif
|
|
|
|
void _nano_task_sleep(int32_t timeout_in_ticks)
|
|
{
|
|
int64_t cur_ticks, limit;
|
|
int key;
|
|
|
|
key = irq_lock();
|
|
cur_ticks = sys_tick_get();
|
|
limit = cur_ticks + timeout_in_ticks;
|
|
|
|
while (cur_ticks < limit) {
|
|
_NANO_TIMEOUT_SET_TASK_TIMEOUT(timeout_in_ticks);
|
|
nano_cpu_atomic_idle(key);
|
|
|
|
key = irq_lock();
|
|
cur_ticks = sys_tick_get();
|
|
_NANO_TIMEOUT_UPDATE(timeout_in_ticks, limit, cur_ticks);
|
|
}
|
|
|
|
irq_unlock(key);
|
|
}
|