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