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
|
__attribute__((always_inline))
static inline void print_int8(volatile char *uart, unsigned x)
{
*uart = ((x >> 4) & 0xf) + '0';
*uart = ((x >> 0) & 0xf) + '0';
}
__attribute__((always_inline))
static inline void print_addr(volatile char *uart, unsigned x, unsigned y,
unsigned z)
{
*uart = '(';
print_int8(uart, x);
*uart = ',';
*uart = ' ';
print_int8(uart, y);
*uart = ',';
*uart = ' ';
print_int8(uart, z);
*uart = ')';
*uart = '\n';
}
__attribute__((always_inline))
static inline unsigned wrap(unsigned x, unsigned X)
{
return x + 1 >= X ? 0 : x + 1;
}
__attribute__((always_inline))
static inline unsigned next_idx(unsigned x, unsigned y, unsigned z, unsigned X,
unsigned Y, unsigned Z)
{
unsigned zi = wrap(z, Z);
unsigned yi = zi < z ? wrap(y, Y) : y;
unsigned xi = yi < y ? wrap(x, X) : x;
return (xi << 16) | (yi << 8) | zi;
}
void _start(unsigned x, unsigned y, unsigned z, unsigned X, unsigned Y,
unsigned Z)
{
volatile char *uart = (char *)4096;
volatile unsigned *control = (unsigned *)(1ULL << 56);
if (x == 0 && y == 0 && z == 2) {
goto do_work;
} else {
while (*control != ((x << 16) | (y << 8) | z)) {}
}
do_work:
print_addr(uart, x, y, z);
*control = next_idx(x, y, z, X, Y, Z);
if (x == X - 1 && y == Y - 1 && z == Z - 1)
asm ("ebreak");
/* otherwise just loop */
while (1) {}
}
|
