From e991095180f774e3582329447c291a11499989ba Mon Sep 17 00:00:00 2001 From: Kimplul Date: Mon, 24 Feb 2025 21:31:46 +0200 Subject: overhaul meshes + Previous name was grid --- tests/simple_mesh/test.c | 55 ++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 55 insertions(+) create mode 100644 tests/simple_mesh/test.c (limited to 'tests/simple_mesh/test.c') diff --git a/tests/simple_mesh/test.c b/tests/simple_mesh/test.c new file mode 100644 index 0000000..b1bbe84 --- /dev/null +++ b/tests/simple_mesh/test.c @@ -0,0 +1,55 @@ +__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) +{ + *uart = '('; + print_int8(uart, x); + *uart = ','; + *uart = ' '; + print_int8(uart, y); + *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 X, unsigned Y) +{ + unsigned yi = wrap(y, Y); + unsigned xi = yi < y ? wrap(x, X) : x; + + return (xi << 16) | yi; +} + +void _start(unsigned x, unsigned y, unsigned X, unsigned Y) +{ + volatile char *uart = (char *)4096; + volatile unsigned *control = (unsigned *)(1ULL << 48); + + if (x == 0 && y == 2) { + goto do_work; + } else { + while (*control != ((x << 16) | y)) {} + } + +do_work: + print_addr(uart, x, y); + *control = next_idx(x, y, X, Y); + + if (x == X - 1 && y == Y - 1) + asm("ebreak"); + + /* otherwise just loop */ + while (1) {} +} -- cgit v1.3