avr-fw-modules/core/src/wait_ms.c

#include <sys/systick.h>
#include <sys/atomic.h>
#include <sys/threads.h>

void wait_ms(uint32_t ms)
{
	current_thread()->timeout = _systick_ticks + (systick_t)((systick_t)1000L * (systick_t)ms);
	thread_sleep( current_thread() );
};