67 lines
1.8 KiB
C
67 lines
1.8 KiB
C
/*
|
|
* Copyright (c) 2017 Oticon A/S
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <stdbool.h>
|
|
#include "zephyr/types.h"
|
|
#include "fake_timer.h"
|
|
#include "time_machine.h"
|
|
#include <zephyr/arch/posix/posix_soc_if.h>
|
|
#include <posix_board_if.h>
|
|
#include <posix_soc.h>
|
|
|
|
/**
|
|
* Replacement to the kernel k_busy_wait()
|
|
* Will block this thread (and therefore the whole Zephyr) during usec_to_wait
|
|
*
|
|
* Note that interrupts may be received in the meanwhile and that therefore this
|
|
* thread may lose context.
|
|
* Therefore the wait time may be considerably longer.
|
|
*
|
|
* All this function ensures is that it will return after usec_to_wait or later.
|
|
*/
|
|
void arch_busy_wait(uint32_t usec_to_wait)
|
|
{
|
|
bs_time_t time_end = tm_get_hw_time() + usec_to_wait;
|
|
|
|
while (tm_get_hw_time() < time_end) {
|
|
/*
|
|
* There may be wakes due to other interrupts or nested calls to
|
|
* k_busy_wait in interrupt handlers
|
|
*/
|
|
fake_timer_wake_in_time(time_end);
|
|
posix_halt_cpu();
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Will block this thread (and therefore the whole Zephyr) during usec_to_waste
|
|
*
|
|
* Very similar to arch_busy_wait(), but if an interrupt or context switch
|
|
* occurs this function will continue waiting after, ensuring that
|
|
* usec_to_waste are spent in this context, irrespectively of how much more
|
|
* time would be spent on interrupt handling or possible switched-in tasks.
|
|
*
|
|
* Can be used to emulate code execution time.
|
|
*/
|
|
void posix_cpu_hold(uint32_t usec_to_waste)
|
|
{
|
|
bs_time_t time_start;
|
|
int64_t to_wait = usec_to_waste;
|
|
|
|
while (to_wait > 0) {
|
|
/*
|
|
* There may be wakes due to other interrupts or nested calls to
|
|
* cpu_hold in interrupt handlers
|
|
*/
|
|
time_start = tm_get_hw_time();
|
|
fake_timer_wake_in_time(time_start + to_wait);
|
|
posix_change_cpu_state_and_wait(true);
|
|
to_wait -= tm_get_hw_time() - time_start;
|
|
|
|
posix_irq_handler();
|
|
}
|
|
}
|