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
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
|
/*
* nano-monitor for MIPS CPU
*
* Copyright (C) 2013 Antony Pavlov <antonynpavlov@gmail.com>
*
* This file is part of barebox.
* See file CREDITS for list of people who contributed to this project.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2
* as published by the Free Software Foundation.
*
* 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.
*
*/
#include <mach/debug_ll.h>
#define CODE_ESC 0x1b
/*
* Delay slot warning!
*
* NMON was made with code portability in mind.
* So it uses '.set reorder' directives allowing
* assembler to insert necessary 'nop' instructions
* into delay slots (after branch instruction) and
* into load delay slot (after memory load instruction
* on very old R2000/R3000 processors).
*/
.macro nmon_outs msg
.set push
.set reorder
ADR a1, \msg, t1
bal _nmon_outs
.set pop
.endm
/*
* output a 32-bit value in hex
*/
.macro debug_ll_outhexw
#ifdef CONFIG_DEBUG_LL
.set push
.set reorder
move t6, a0
li t5, 32
202:
addi t5, t5, -4
srlv a0, t6, t5
/* output one hex digit */
andi a0, a0, 15
blt a0, 10, 203f
addi a0, a0, ('a' - '9' - 1)
203:
addi a0, a0, '0'
debug_ll_outc_a0
bgtz t5, 202b
.set pop
#endif /* CONFIG_DEBUG_LL */
.endm
.macro mips_nmon
.set push
.set reorder
#ifdef CONFIG_NMON
#ifdef CONFIG_NMON_USER_START
#if CONFIG_NMON_USER_START_DELAY < 1
#error CONFIG_NMON_USER_START_DELAY must be >= 1!
#endif
nmon_outs msg_nmon_press_any_key
li s0, CONFIG_NMON_USER_START_DELAY
move s1, s0
1:
li a0, '.'
bal _nmon_outc_a0
addi s1, s1, -1
bnez s1, 1b
move s1, s0
nmon_wait_user:
pbl_sleep s2, CONFIG_NMON_1S_DELAY
nmon_outs msg_bsp
debug_ll_tstc
bnez v0, 3f
addi s1, s1, -1
bnez s1, nmon_wait_user
nmon_outs msg_skipping_nmon
b nmon_exit
msg_nmon_press_any_key:
.asciz "\r\npress any key to start nmon\r\n"
.align 4
3:
/* get received char from ns16550's buffer */
debug_ll_getc
#endif /* CONFIG_NMON_USER_START */
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
/* prepare a0 for debug_ll_outc_a0 */
move a0, v0
li v1, 'q'
bne v0, v1, 3f
bal _nmon_outc_a0
b nmon_exit
3:
li v1, 'd'
beq v0, v1, nmon_cmd_d
li v1, 'w'
beq v0, v1, nmon_cmd_w
li v1, 'g'
beq v0, v1, nmon_cmd_g
b nmon_main_help
nmon_cmd_d:
bal _nmon_outc_a0
li a0, ' '
bal _nmon_outc_a0
bal _nmon_gethexw
nmon_outs msg_nl
lw a0, (v0)
debug_ll_outhexw
b nmon_main
nmon_cmd_w:
bal _nmon_outc_a0
li a0, ' '
bal _nmon_outc_a0
bal _nmon_gethexw
move s0, v0
li a0, ' '
bal _nmon_outc_a0
bal _nmon_gethexw
sw v0, (s0)
b nmon_main
nmon_cmd_g:
bal _nmon_outc_a0
li a0, ' '
bal _nmon_outc_a0
bal _nmon_gethexw
nmon_outs msg_nl
jal v0
b nmon_main
_nmon_outc_a0:
debug_ll_outc_a0
jr ra
_nmon_outs:
lbu a0, 0(a1)
addi a1, a1, 1
beqz a0, _nmon_jr_ra_exit
debug_ll_outc_a0
b _nmon_outs
_nmon_gethexw:
li t3, 8
li t2, 0
_get_hex_digit:
debug_ll_getc
li v1, CODE_ESC
beq v0, v1, nmon_main
li v1, '0'
bge v0, v1, 0f
b _get_hex_digit
0:
li v1, '9'
ble v0, v1, 9f
li v1, 'f'
ble v0, v1, 1f
b _get_hex_digit
1:
li v1, 'a'
bge v0, v1, 8f
b _get_hex_digit
8: /* v0 \in {'a', 'b' ... 'f'} */
sub a3, v0, v1
addi a3, 0xa
b 0f
9: /* v0 \in {'0', '1' ... '9'} */
li a3, '0'
sub a3, v0, a3
0: move a0, v0
debug_ll_outc_a0
sll t2, t2, 4
or t2, t2, a3
sub t3, t3, 1
beqz t3, 0f
b _get_hex_digit
0:
move v0, t2
_nmon_jr_ra_exit:
jr ra
msg_prompt:
.asciz "\r\nnmon> "
msg_nl:
.asciz "\r\n"
msg_bsp:
.asciz "\b \b"
msg_skipping_nmon:
.asciz "skipping nmon..."
#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 4
nmon_exit:
nmon_outs msg_nl
#endif /* CONFIG_NMON */
.set pop
.endm
|
