45 lines
826 B
C
45 lines
826 B
C
/*
|
|
* Copyright (c) 2016 Jean-Paul Etienne <fractalclone@gmail.com>
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <irq.h>
|
|
#include <irq_offload.h>
|
|
#include <misc/printk.h>
|
|
|
|
volatile irq_offload_routine_t _offload_routine;
|
|
static volatile void *offload_param;
|
|
|
|
/*
|
|
* Called by _enter_irq
|
|
*
|
|
* Just in case the offload routine itself generates an unhandled
|
|
* exception, clear the offload_routine global before executing.
|
|
*/
|
|
void _irq_do_offload(void)
|
|
{
|
|
irq_offload_routine_t tmp;
|
|
|
|
if (!_offload_routine)
|
|
return;
|
|
|
|
tmp = _offload_routine;
|
|
_offload_routine = NULL;
|
|
|
|
tmp((void *)offload_param);
|
|
}
|
|
|
|
void irq_offload(irq_offload_routine_t routine, void *parameter)
|
|
{
|
|
unsigned int key;
|
|
|
|
key = irq_lock();
|
|
_offload_routine = routine;
|
|
offload_param = parameter;
|
|
|
|
__asm__ volatile ("ecall");
|
|
|
|
irq_unlock(key);
|
|
}
|