1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (c) 2014 Google, Inc.
4 */
5
6 #define IOTRACE_IMPL
7
8 #include <common.h>
9 #include <mapmem.h>
10 #include <time.h>
11 #include <asm/global_data.h>
12 #include <asm/io.h>
13 #include <linux/bug.h>
14 #include <u-boot/crc.h>
15
16 DECLARE_GLOBAL_DATA_PTR;
17
18 /**
19 * struct iotrace - current trace status and checksum
20 *
21 * @start: Start address of iotrace buffer
22 * @size: Actual size of iotrace buffer in bytes
23 * @needed_size: Needed of iotrace buffer in bytes
24 * @offset: Current write offset into iotrace buffer
25 * @region_start: Address of IO region to trace
26 * @region_size: Size of region to trace. if 0 will trace all address space
27 * @crc32: Current value of CRC chceksum of trace records
28 * @enabled: true if enabled, false if disabled
29 */
30 static struct iotrace {
31 ulong start;
32 ulong size;
33 ulong needed_size;
34 ulong offset;
35 ulong region_start;
36 ulong region_size;
37 u32 crc32;
38 bool enabled;
39 } iotrace;
40
add_record(int flags,const void * ptr,ulong value)41 static void add_record(int flags, const void *ptr, ulong value)
42 {
43 struct iotrace_record srec, *rec = &srec;
44
45 /*
46 * We don't support iotrace before relocation. Since the trace buffer
47 * is set up by a command, it can't be enabled at present. To change
48 * this we would need to set the iotrace buffer at build-time. See
49 * lib/trace.c for how this might be done if you are interested.
50 */
51 if (!(gd->flags & GD_FLG_RELOC) || !iotrace.enabled)
52 return;
53
54 if (iotrace.region_size)
55 if ((ulong)ptr < iotrace.region_start ||
56 (ulong)ptr > iotrace.region_start + iotrace.region_size)
57 return;
58
59 /* Store it if there is room */
60 if (iotrace.offset + sizeof(*rec) < iotrace.size) {
61 rec = (struct iotrace_record *)map_sysmem(
62 iotrace.start + iotrace.offset,
63 sizeof(value));
64 } else {
65 WARN_ONCE(1, "WARNING: iotrace buffer exhausted, please check needed length using \"iotrace stats\"\n");
66 iotrace.needed_size += sizeof(struct iotrace_record);
67 return;
68 }
69
70 rec->timestamp = timer_get_us();
71 rec->flags = flags;
72 rec->addr = map_to_sysmem(ptr);
73 rec->value = value;
74
75 /* Update our checksum */
76 iotrace.crc32 = crc32(iotrace.crc32, (unsigned char *)rec,
77 sizeof(*rec));
78
79 iotrace.needed_size += sizeof(struct iotrace_record);
80 iotrace.offset += sizeof(struct iotrace_record);
81 }
82
iotrace_readl(const void * ptr)83 u32 iotrace_readl(const void *ptr)
84 {
85 u32 v;
86
87 v = readl(ptr);
88 add_record(IOT_32 | IOT_READ, ptr, v);
89
90 return v;
91 }
92
iotrace_writel(ulong value,void * ptr)93 void iotrace_writel(ulong value, void *ptr)
94 {
95 add_record(IOT_32 | IOT_WRITE, ptr, value);
96 writel(value, ptr);
97 }
98
iotrace_readw(const void * ptr)99 u16 iotrace_readw(const void *ptr)
100 {
101 u32 v;
102
103 v = readw(ptr);
104 add_record(IOT_16 | IOT_READ, ptr, v);
105
106 return v;
107 }
108
iotrace_writew(ulong value,void * ptr)109 void iotrace_writew(ulong value, void *ptr)
110 {
111 add_record(IOT_16 | IOT_WRITE, ptr, value);
112 writew(value, ptr);
113 }
114
iotrace_readb(const void * ptr)115 u8 iotrace_readb(const void *ptr)
116 {
117 u32 v;
118
119 v = readb(ptr);
120 add_record(IOT_8 | IOT_READ, ptr, v);
121
122 return v;
123 }
124
iotrace_writeb(ulong value,void * ptr)125 void iotrace_writeb(ulong value, void *ptr)
126 {
127 add_record(IOT_8 | IOT_WRITE, ptr, value);
128 writeb(value, ptr);
129 }
130
iotrace_reset_checksum(void)131 void iotrace_reset_checksum(void)
132 {
133 iotrace.crc32 = 0;
134 }
135
iotrace_get_checksum(void)136 u32 iotrace_get_checksum(void)
137 {
138 return iotrace.crc32;
139 }
140
iotrace_set_region(ulong start,ulong size)141 void iotrace_set_region(ulong start, ulong size)
142 {
143 iotrace.region_start = start;
144 iotrace.region_size = size;
145 }
146
iotrace_reset_region(void)147 void iotrace_reset_region(void)
148 {
149 iotrace.region_start = 0;
150 iotrace.region_size = 0;
151 }
152
iotrace_get_region(ulong * start,ulong * size)153 void iotrace_get_region(ulong *start, ulong *size)
154 {
155 *start = iotrace.region_start;
156 *size = iotrace.region_size;
157 }
158
iotrace_set_enabled(int enable)159 void iotrace_set_enabled(int enable)
160 {
161 iotrace.enabled = enable;
162 }
163
iotrace_get_enabled(void)164 int iotrace_get_enabled(void)
165 {
166 return iotrace.enabled;
167 }
168
iotrace_set_buffer(ulong start,ulong size)169 void iotrace_set_buffer(ulong start, ulong size)
170 {
171 iotrace.start = start;
172 iotrace.size = size;
173 iotrace.offset = 0;
174 iotrace.crc32 = 0;
175 }
176
iotrace_get_buffer(ulong * start,ulong * size,ulong * needed_size,ulong * offset,ulong * count)177 void iotrace_get_buffer(ulong *start, ulong *size, ulong *needed_size, ulong *offset, ulong *count)
178 {
179 *start = iotrace.start;
180 *size = iotrace.size;
181 *needed_size = iotrace.needed_size;
182 *offset = iotrace.offset;
183 *count = iotrace.offset / sizeof(struct iotrace_record);
184 }
185