irq.c
1.02 KB
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
/*
* Copyright (C) 2014 Freie Universität Berlin
*
* This file is subject to the terms and conditions of the GNU Lesser
* General Public License v2.1. See the file LICENSE in the top level
* directory for more details.
*/
/**
* @ingroup cpu
* @{
*
* @file
* @brief ISR related functions
*
* @author Kaspar Schleiser <kaspar@schleiser.de>
* @author Oliver Hahm <oliver.hahm@inria.fr>
*
* @}
*/
#include "irq.h"
#include "cpu.h"
volatile int __irq_is_in = 0;
char __isr_stack[ISR_STACKSIZE];
unsigned int irq_disable(void)
{
unsigned int state;
__asm__("mov.w r2,%0" : "=r"(state));
state &= GIE;
if (state) {
__disable_irq();
}
return state;
}
unsigned int irq_enable(void)
{
unsigned int state;
__asm__("mov.w r2,%0" : "=r"(state));
state &= GIE;
if (!state) {
__enable_irq();
}
return state;
}
void irq_restore(unsigned int state)
{
if (state) {
__enable_irq();
}
}
int irq_is_in(void)
{
return __irq_is_in;
}