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
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
|
/* SPDX-License-Identifier: GPL-2.0-only */
/*
* nano-monitor for RISC-V CPU
*
* Copyright (C) 2016, 2017 Antony Pavlov <antonynpavlov@gmail.com>
*
* This file is part of barebox.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
*/
#ifndef __ASM_RISCV_NMON_H
#define __ASM_RISCV_NMON_H
#define CODE_ESC 0x1b
.macro nmon_outs msg
la a1, \msg
jal _nmon_outs
.endm
/*
* output a 32-bit value in hex
*/
.macro debug_ll_outhexw
#ifdef CONFIG_DEBUG_LL
move t6, a0
li t5, 32
202:
addi t5, t5, -4
srl a0, t6, t5
/* output one hex digit */
andi a0, a0, 15
li t4, 10
blt a0, t4, 203f
addi a0, a0, ('a' - '9' - 1)
203:
addi a0, a0, '0'
debug_ll_outc_a0
li t4, 1
bge t5, t4, 202b
#endif /* CONFIG_DEBUG_LL */
.endm
.macro riscv_nmon
#ifdef CONFIG_NMON
nmon_main_help:
#ifdef CONFIG_NMON_HELP
nmon_outs msg_nmon_help
#endif /* CONFIG_NMON_HELP */
nmon_main:
nmon_outs msg_prompt
debug_ll_getc
li a0, 'q'
bne s0, a0, 3f
jal _nmon_outc_a0
j nmon_exit
3:
li a0, 'd'
beq s0, a0, nmon_cmd_d
li a0, 'w'
beq s0, a0, nmon_cmd_w
li a0, 'g'
beq s0, a0, nmon_cmd_g
j nmon_main_help
nmon_cmd_d:
jal _nmon_outc_a0
li a0, ' '
jal _nmon_outc_a0
jal _nmon_gethexw
nmon_outs msg_nl
lw a0, (s0)
debug_ll_outhexw
j nmon_main
nmon_cmd_w:
jal _nmon_outc_a0
li a0, ' '
jal _nmon_outc_a0
jal _nmon_gethexw
move s2, s0
li a0, ' '
jal _nmon_outc_a0
jal _nmon_gethexw
sw s0, 0(s2)
j nmon_main
nmon_cmd_g:
jal _nmon_outc_a0
li a0, ' '
jal _nmon_outc_a0
jal _nmon_gethexw
move s2, s0
nmon_outs msg_nl
jalr s2
j nmon_main
_nmon_outc_a0:
debug_ll_outc_a0
jr ra
_nmon_outs:
lb a0, 0(a1)
addi a1, a1, 1
beqz a0, _nmon_jr_ra_exit
debug_ll_outc_a0
j _nmon_outs
_nmon_gethexw:
li t3, 8
li t2, 0
_get_hex_digit:
debug_ll_getc
li s1, CODE_ESC
beq s0, s1, nmon_main
li s1, '0'
bge s0, s1, 0f
j _get_hex_digit
0:
li s1, '9'
ble s0, s1, 9f
li s1, 'f'
ble s0, s1, 1f
j _get_hex_digit
1:
li s1, 'a'
bge s0, s1, 8f
j _get_hex_digit
8: /* s0 \in {'a', 'b' ... 'f'} */
sub a3, s0, s1
addi a3, a3, 0xa
j 0f
9: /* s0 \in {'0', '1' ... '9'} */
li a3, '0'
sub a3, s0, a3
0: move a0, s0
debug_ll_outc_a0
sll t2, t2, 4
or t2, t2, a3
li t0, 1
sub t3, t3, t0
beqz t3, 0f
j _get_hex_digit
0:
move s0, t2
_nmon_jr_ra_exit:
jr ra
msg_prompt:
.asciz "\r\nnmon> "
msg_nl:
.asciz "\r\n"
msg_bsp:
.asciz "\b \b"
#ifdef CONFIG_NMON_HELP
msg_nmon_help:
.ascii "\r\n\r\nnmon commands:\r\n"
.ascii " q - quit\r\n"
.ascii " d <addr> - read 32-bit word from <addr>\r\n"
.ascii " w <addr> <val> - write 32-bit word to <addr>\r\n"
.ascii " g <addr> - jump to <addr>\r\n"
.asciz " use <ESC> key to interrupt current command\r\n"
#endif /* CONFIG_NMON_HELP */
.align 2
nmon_exit:
nmon_outs msg_nl
#endif /* CONFIG_NMON */
.endm
#endif /* __ASM_RISCV_NMON_H */
|
