blob: db90d34e12c69259ef65bf5c11d4dcb17ae6254b (
plain) (
blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
|
/* SPDX-License-Identifier: copyleft-next-0.3.1 */
/* Copyright 2023, Kim Kuparinen < kimi.h.kuparinen@gmail.com > */
/**
* @file irq.c
* Common IRQ handling stuff implementations.
*/
#include <kmi/irq.h>
#include <kmi/pmem.h>
#include <kmi/debug.h>
#include <kmi/assert.h>
#include <kmi/string.h>
#include <arch/irq.h>
/** Hold maximum IRQ id supported by system. */
static size_t max_irq;
/** Hold map of IRD ID -> thread id. @todo process id? */
static id_t *irq_map;
void init_irq(void *fdt)
{
/** @todo check arch max irq and adjust accordingly */
irq_map = (id_t *)alloc_page(MM_O0);
memset(irq_map, 0, order_size(MM_O0));
max_irq = order_size(MM_O0) / sizeof(irq_map[0]);
setup_irq(fdt);
}
stat_t register_irq(struct tcb *t, irq_t id)
{
if (id >= max_irq)
return ERR_INVAL;
if (irq_map[id])
return ERR_EXT;
irq_map[id] = t->tid;
return activate_irq(id);
}
stat_t unregister_irq(struct tcb *t, irq_t id)
{
id_t tid = irq_map[id];
if (tid != t->tid)
return ERR_PERM;
irq_map[id] = 0;
return deactivate_irq(id);
}
void handle_irq()
{
irq_t id = get_irq();
hard_assert(id < max_irq, RETURN_VOID);
id_t tid = irq_map[id];
if (!tid) {
bug("unregistered irq: %llu\n", (unsigned long long)id);
return;
}
/** @todo switch to thread */
}
|
