/
utils.h
70 lines (53 loc) · 960 Bytes
/
utils.h
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
68
69
#ifndef _UTILS_H_
#define _UTILS_H_
#include "types.h"
static inline u32 Read32(u32 addr)
{
u32 ret;
__asm__ volatile("ldr\t%0, [%1]" : "=l"(ret) : "l"(addr));
return ret;
}
static inline void Write32(u32 addr, u32 val)
{
__asm__ volatile("str\t%0, [%1]" : : "l"(val), "l"(addr));
}
static inline u32 Get32(u32 addr, u32 bit)
{
u32 val = (1 << bit);
u32 ret;
__asm__ volatile(
"ldr\t%0, [%1]\n"
"and\t%0, %2\n"
"lsr\t%0, %3\n"
: "=&l"(ret)
: "l"(addr), "l"(val), "l"(bit)
);
return ret;
}
static inline u32 Set32(u32 addr, u32 bit)
{
u32 val = (1 << bit);
u32 ret;
__asm__ volatile(
"ldr\t%0, [%1]\n"
"orr\t%0, %2\n"
"str\t%0, [%1]\n"
: "=&l"(ret)
: "l"(addr), "l"(val)
);
return ret;
}
static inline u32 Clear32(u32 addr, u32 bit)
{
u32 val = (1 << bit);
u32 ret;
__asm__ volatile(
"ldr\t%0, [%1]\n"
"bic\t%0, %2\n"
"str\t%0, [%1]\n"
: "=&l"(ret)
: "l"(addr), "l"(val)
);
return ret;
}
#endif