bmkernel/main.c at master · OpenNoah/bmkernel · GitHub

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
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
#include <stdint.h>
#include "uart.h"
#include "wdt.h"
#include "lcd.h"
#include "helper.h"

#if 0
static void reg_dump(hw_uart_t *uart)
{
	uart_puts(uart, "Register dump:\r\n");

	static const struct {
		uint32_t base;
		uint32_t size;
	} regs[] = {
		{0x13010010, 0x00000030},
		{0x13010050, 0x00000004},
		{0x13010080, 0x00000030},
		{0x13010100, 0x00000030},
		{0x13050000, 0x00000060},
		{0, 0},
	};
	for (uint32_t idx = 0; regs[idx].base; idx++) {
		for (uint32_t i = 0; i < regs[idx].size; i += 4) {
			volatile uint32_t *p = (volatile uint32_t *)(regs[idx].base + i);
			uint32_t v = *p;
			uart_puts(uart, "0x");
			uart_puthex(uart, (uint32_t)p, 8);
			uart_puts(uart, ": 0x");
			uart_puthex(uart, v, 8);
			uart_puts(uart, "\r\n");
		}
	}
}
#endif

static void mem_read_line(hw_uart_t *uart, const char *line)
{
	uint32_t addr = 0;
	get_hex_u32(&line[2], &addr);
	if (addr == 0)
		return;
	uint32_t v = *(uint32_t *)addr;
	uart_puts(uart, "0x");
	uart_puthex(uart, addr, 8);
	uart_puts(uart, " = 0x");
	uart_puthex(uart, v, 8);
	uart_puts(uart, "\r\n");
}

static void mem_write_line(hw_uart_t *uart, const char *line)
{
	uint32_t addr = 0;
	line = get_hex_u32(&line[2], &addr);
	if (addr == 0 || *line++ == '\0')
		return;
	uint32_t v = 0;
	get_hex_u32(line, &v);
	*(uint32_t *)addr = v;

	v = *(uint32_t *)addr;
	uart_puts(uart, "0x");
	uart_puthex(uart, addr, 8);
	uart_puts(uart, " = 0x");
	uart_puthex(uart, v, 8);
	uart_puts(uart, "\r\n");
}

static void mem_fill_line(hw_uart_t *uart, const char *line)
{
	uint32_t addr = 0;
	line = get_hex_u32(&line[2], &addr);
	if (addr == 0 || *line++ == '\0')
		return;
	uint32_t size = 0;
	line = get_hex_u32(line, &size);
	if (size == 0 || *line++ == '\0')
		return;
	uint32_t v = 0;
	get_hex_u32(line, &v);
	for (uint32_t i = 0; i < size / 4; i++)
		*((uint32_t *)addr + i) = v;

	v = *(uint32_t *)addr;
	uart_puts(uart, "0x");
	uart_puthex(uart, addr, 8);
	uart_puts(uart, " = 0x");
	uart_puthex(uart, v, 8);
	uart_puts(uart, "\r\n");
}

int main()
{
	hw_uart_t *uart = UART0_BASE;
	uart_init(uart);

	lcd_init(uart);

	uart_puts(uart, "Test kernel run!\r\nsp = 0x");

	register unsigned sp asm("sp");
	uart_puthex(uart, sp, 8);
	uart_puts(uart, "\r\n");

	for (;;) {
		uart_puts(uart, "> ");
		char *line = uart_get_line(uart);
		if (line[0] == 0)
			continue;

		switch (line[0]) {
		case 'r':
			mem_read_line(uart, line);
			break;
		case 'w':
			mem_write_line(uart, line);
			break;
		case 'f':
			mem_fill_line(uart, line);
			break;
		case '*':
			wdt_reset(uart);
			break;
		}
	}

	wdt_reset(uart);
	return 0;
}