1
2
3
4
5
6
7
8
9
10
11
12#include <linux/linkage.h>
13
14 .text
15
16
17
18
19
20
21
22
23 @@ debug using ARM EmbeddedICE DCC channel
24
25
26
27 .macro addruart, rx
28 .endm
29
30 .macro senduart, rd, rx
31 mcr p14, 0, \rd, c0, c5, 0
32 .endm
33
34 .macro busyuart, rd, rx
351001:
36 mrc p14, 0, \rx, c0, c1, 0
37 tst \rx,
38 beq 1001b
39 .endm
40
41 .macro waituart, rd, rx
42 mov \rd,
431001:
44 subs \rd, \rd,
45 bmi 1002f
46 mrc p14, 0, \rx, c0, c1, 0
47 tst \rx,
48 bne 1001b
491002:
50 .endm
51
52#else
53
54 .macro addruart, rx
55 .endm
56
57 .macro senduart, rd, rx
58 mcr p14, 0, \rd, c1, c0, 0
59 .endm
60
61 .macro busyuart, rd, rx
621001:
63 mrc p14, 0, \rx, c0, c0, 0
64 tst \rx,
65 beq 1001b
66
67 .endm
68
69 .macro waituart, rd, rx
70 mov \rd,
711001:
72 subs \rd, \rd,
73 bmi 1002f
74 mrc p14, 0, \rx, c0, c0, 0
75 tst \rx,
76 bne 1001b
771002:
78 .endm
79
80#endif
81
82#else
83#include <asm/arch/debug-macro.S>
84#endif
85
86
87
88
89ENTRY(printhex8)
90 mov r1,
91 b printhex
92
93ENTRY(printhex4)
94 mov r1,
95 b printhex
96
97ENTRY(printhex2)
98 mov r1,
99printhex: adr r2, hexbuf
100 add r3, r2, r1
101 mov r1,
102 strb r1, [r3]
1031: and r1, r0,
104 mov r0, r0, lsr
105 cmp r1,
106 addlt r1, r1,
107 addge r1, r1,
108 strb r1, [r3,
109 teq r3, r2
110 bne 1b
111 mov r0, r2
112 b printascii
113
114 .ltorg
115
116ENTRY(printascii)
117 addruart r3
118 b 2f
1191: waituart r2, r3
120 senduart r1, r3
121 busyuart r2, r3
122 teq r1,
123 moveq r1,
124 beq 1b
1252: teq r0,
126 ldrneb r1, [r0],
127 teqne r1,
128 bne 1b
129 mov pc, lr
130
131ENTRY(printch)
132 addruart r3
133 mov r1, r0
134 mov r0,
135 b 1b
136
137hexbuf: .space 16
138