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
130
131
|
/*
* Copyright © 2020-2022 The Crust Firmware Authors.
* SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0-only
*/
#include <debug.h>
#include <mmio.h>
#include <regmap.h>
#include <serial.h>
#include <stdbool.h>
#include <stddef.h>
#include <stdint.h>
#include <system.h>
#include <mfd/axp20x.h>
#define MAX_LENGTH 23 /* "m 0x???????? 0x????????" */
static char buffer[MAX_LENGTH + 1];
static uint8_t length;
static bool
parse_hex(const char **str, uint32_t *num)
{
uint32_t n = 0;
const char *s = *str;
bool ret = false;
/* Skip spaces. */
while (*s == ' ')
++s;
/* At least one space must precede the number. */
if (s == *str)
return false;
/* Consume as many hex digits as found. */
for (;;) {
uint32_t c = *s | 0x20;
uint32_t digit;
if (c - '0' < 10)
digit = c - '0';
else if (c - 'a' < 6)
digit = c - ('a' - 10);
else if (c == 'x')
digit = 0;
else
break;
++s;
n = n << 4 | digit;
ret = true;
}
*str = s;
*num = n;
return ret;
}
static void
run_command(const char *cmd)
{
uint32_t addr, len;
switch (*cmd++) {
case 'd':
/* Hex dump: "d xxxxxxxx xxxxxxxx", arguments in bare hex. */
if (parse_hex(&cmd, &addr) && parse_hex(&cmd, &len))
hexdump(addr, len);
return;
case 'm':
/* MMIO: "m xxxxxxxx" or "m xxxxxxxx xxxxxxxx", bare hex. */
if (parse_hex(&cmd, &addr)) {
uint32_t val;
if (parse_hex(&cmd, &val))
mmio_write_32(addr, val);
log("%08x: %08x\n", addr, mmio_read_32(addr));
}
return;
#if CONFIG(DEBUG_MONITOR_PMIC)
case 'p':
/* PMIC: "p xx" or "p xx xx", bare hex. */
if (parse_hex(&cmd, &addr)) {
const struct regmap *map = &axp20x.map;
uint32_t val32;
uint8_t val8;
if (regmap_user_probe(map))
return;
if (parse_hex(&cmd, &val32))
regmap_write(map, addr, val32);
regmap_read(map, addr, &val8);
log("%02x: %02x\n", addr, val8);
regmap_user_release(map);
}
return;
#endif
case 'w':
/* Wake: "w". */
system_wake();
return;
}
}
void
debug_monitor(void)
{
unsigned char c;
if (!serial_ready())
return;
if (!(c = serial_getc()))
return;
if (c < ' ' || length == MAX_LENGTH) {
serial_putc('\n');
if (c == '\r') {
buffer[length] = 0;
run_command(buffer);
}
serial_puts("> ");
length = 0;
} else {
serial_putc(c);
buffer[length++] = c;
}
}
|
