Merge git://git.kernel.org/pub/scm/linux/kernel/git/czankel/xtensa-2.6
[linux-2.6-block.git] / kernel / trace / trace_mmiotrace.c
CommitLineData
f984b51e
PP
1/*
2 * Memory mapped I/O tracing
3 *
4 * Copyright (C) 2008 Pekka Paalanen <pq@iki.fi>
5 */
6
7#define DEBUG 1
8
9#include <linux/kernel.h>
10#include <linux/mmiotrace.h>
13829537 11#include <linux/pci.h>
f984b51e
PP
12
13#include "trace.h"
14
d0a7e8ca
PP
15struct header_iter {
16 struct pci_dev *dev;
17};
18
f984b51e 19static struct trace_array *mmio_trace_array;
2039238b 20static bool overrun_detected;
7ee1768d 21static unsigned long prev_overruns;
f984b51e 22
bd8ac686
PP
23static void mmio_reset_data(struct trace_array *tr)
24{
2039238b 25 overrun_detected = false;
7ee1768d 26 prev_overruns = 0;
bd8ac686 27
213cc060 28 tracing_reset_online_cpus(tr);
bd8ac686 29}
f984b51e 30
1c80025a 31static int mmio_trace_init(struct trace_array *tr)
f984b51e
PP
32{
33 pr_debug("in %s\n", __func__);
34 mmio_trace_array = tr;
c76f0694
SR
35
36 mmio_reset_data(tr);
37 enable_mmiotrace();
1c80025a 38 return 0;
f984b51e
PP
39}
40
41static void mmio_trace_reset(struct trace_array *tr)
42{
43 pr_debug("in %s\n", __func__);
c76f0694
SR
44
45 disable_mmiotrace();
bd8ac686
PP
46 mmio_reset_data(tr);
47 mmio_trace_array = NULL;
f984b51e
PP
48}
49
bbf5b1a0 50static void mmio_trace_start(struct trace_array *tr)
f984b51e
PP
51{
52 pr_debug("in %s\n", __func__);
bbf5b1a0 53 mmio_reset_data(tr);
bd8ac686
PP
54}
55
13829537
PP
56static int mmio_print_pcidev(struct trace_seq *s, const struct pci_dev *dev)
57{
58 int ret = 0;
59 int i;
60 resource_size_t start, end;
61 const struct pci_driver *drv = pci_dev_driver(dev);
62
63 /* XXX: incomplete checks for trace_seq_printf() return value */
64 ret += trace_seq_printf(s, "PCIDEV %02x%02x %04x%04x %x",
65 dev->bus->number, dev->devfn,
66 dev->vendor, dev->device, dev->irq);
67 /*
68 * XXX: is pci_resource_to_user() appropriate, since we are
69 * supposed to interpret the __ioremap() phys_addr argument based on
70 * these printed values?
71 */
72 for (i = 0; i < 7; i++) {
73 pci_resource_to_user(dev, i, &dev->resource[i], &start, &end);
74 ret += trace_seq_printf(s, " %llx",
75 (unsigned long long)(start |
76 (dev->resource[i].flags & PCI_REGION_FLAG_MASK)));
77 }
78 for (i = 0; i < 7; i++) {
79 pci_resource_to_user(dev, i, &dev->resource[i], &start, &end);
80 ret += trace_seq_printf(s, " %llx",
81 dev->resource[i].start < dev->resource[i].end ?
82 (unsigned long long)(end - start) + 1 : 0);
83 }
84 if (drv)
85 ret += trace_seq_printf(s, " %s\n", drv->name);
86 else
87 ret += trace_seq_printf(s, " \n");
88 return ret;
89}
90
d0a7e8ca
PP
91static void destroy_header_iter(struct header_iter *hiter)
92{
93 if (!hiter)
94 return;
95 pci_dev_put(hiter->dev);
96 kfree(hiter);
97}
98
99static void mmio_pipe_open(struct trace_iterator *iter)
bd8ac686 100{
d0a7e8ca 101 struct header_iter *hiter;
bd8ac686 102 struct trace_seq *s = &iter->seq;
13829537
PP
103
104 trace_seq_printf(s, "VERSION 20070824\n");
105
d0a7e8ca
PP
106 hiter = kzalloc(sizeof(*hiter), GFP_KERNEL);
107 if (!hiter)
108 return;
109
110 hiter->dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, NULL);
111 iter->private = hiter;
112}
113
114/* XXX: This is not called when the pipe is closed! */
115static void mmio_close(struct trace_iterator *iter)
116{
117 struct header_iter *hiter = iter->private;
118 destroy_header_iter(hiter);
119 iter->private = NULL;
120}
121
2039238b
PP
122static unsigned long count_overruns(struct trace_iterator *iter)
123{
2039238b 124 unsigned long cnt = 0;
7ee1768d
PP
125 unsigned long over = ring_buffer_overruns(iter->tr->buffer);
126
127 if (over > prev_overruns)
128 cnt = over - prev_overruns;
129 prev_overruns = over;
2039238b
PP
130 return cnt;
131}
132
d0a7e8ca
PP
133static ssize_t mmio_read(struct trace_iterator *iter, struct file *filp,
134 char __user *ubuf, size_t cnt, loff_t *ppos)
135{
136 ssize_t ret;
137 struct header_iter *hiter = iter->private;
138 struct trace_seq *s = &iter->seq;
2039238b
PP
139 unsigned long n;
140
141 n = count_overruns(iter);
142 if (n) {
143 /* XXX: This is later than where events were lost. */
144 trace_seq_printf(s, "MARK 0.000000 Lost %lu events.\n", n);
145 if (!overrun_detected)
146 pr_warning("mmiotrace has lost events.\n");
147 overrun_detected = true;
148 goto print_out;
149 }
d0a7e8ca
PP
150
151 if (!hiter)
152 return 0;
153
154 mmio_print_pcidev(s, hiter->dev);
155 hiter->dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, hiter->dev);
156
157 if (!hiter->dev) {
158 destroy_header_iter(hiter);
159 iter->private = NULL;
160 }
161
2039238b 162print_out:
d0a7e8ca
PP
163 ret = trace_seq_to_user(s, ubuf, cnt);
164 return (ret == -EBUSY) ? 0 : ret;
bd8ac686
PP
165}
166
07f4e4f7 167static enum print_line_t mmio_print_rw(struct trace_iterator *iter)
bd8ac686
PP
168{
169 struct trace_entry *entry = iter->ent;
7104f300
SR
170 struct trace_mmiotrace_rw *field;
171 struct mmiotrace_rw *rw;
bd8ac686 172 struct trace_seq *s = &iter->seq;
3928a8a2 173 unsigned long long t = ns2usecs(iter->ts);
bd8ac686
PP
174 unsigned long usec_rem = do_div(t, 1000000ULL);
175 unsigned secs = (unsigned long)t;
176 int ret = 1;
177
7104f300
SR
178 trace_assign_type(field, entry);
179 rw = &field->rw;
180
777e208d 181 switch (rw->opcode) {
bd8ac686
PP
182 case MMIO_READ:
183 ret = trace_seq_printf(s,
dee310d0
PP
184 "R %d %lu.%06lu %d 0x%llx 0x%lx 0x%lx %d\n",
185 rw->width, secs, usec_rem, rw->map_id,
186 (unsigned long long)rw->phys,
736ca61f 187 rw->value, rw->pc, 0);
bd8ac686
PP
188 break;
189 case MMIO_WRITE:
190 ret = trace_seq_printf(s,
dee310d0
PP
191 "W %d %lu.%06lu %d 0x%llx 0x%lx 0x%lx %d\n",
192 rw->width, secs, usec_rem, rw->map_id,
193 (unsigned long long)rw->phys,
736ca61f 194 rw->value, rw->pc, 0);
bd8ac686
PP
195 break;
196 case MMIO_UNKNOWN_OP:
197 ret = trace_seq_printf(s,
dee310d0
PP
198 "UNKNOWN %lu.%06lu %d 0x%llx %02x,%02x,%02x 0x%lx %d\n",
199 secs, usec_rem, rw->map_id,
200 (unsigned long long)rw->phys,
bd8ac686 201 (rw->value >> 16) & 0xff, (rw->value >> 8) & 0xff,
736ca61f 202 (rw->value >> 0) & 0xff, rw->pc, 0);
bd8ac686
PP
203 break;
204 default:
205 ret = trace_seq_printf(s, "rw what?\n");
206 break;
207 }
208 if (ret)
07f4e4f7
FW
209 return TRACE_TYPE_HANDLED;
210 return TRACE_TYPE_PARTIAL_LINE;
bd8ac686
PP
211}
212
07f4e4f7 213static enum print_line_t mmio_print_map(struct trace_iterator *iter)
bd8ac686
PP
214{
215 struct trace_entry *entry = iter->ent;
7104f300
SR
216 struct trace_mmiotrace_map *field;
217 struct mmiotrace_map *m;
bd8ac686 218 struct trace_seq *s = &iter->seq;
3928a8a2 219 unsigned long long t = ns2usecs(iter->ts);
bd8ac686
PP
220 unsigned long usec_rem = do_div(t, 1000000ULL);
221 unsigned secs = (unsigned long)t;
07f4e4f7 222 int ret;
bd8ac686 223
7104f300
SR
224 trace_assign_type(field, entry);
225 m = &field->map;
226
777e208d 227 switch (m->opcode) {
bd8ac686
PP
228 case MMIO_PROBE:
229 ret = trace_seq_printf(s,
dee310d0
PP
230 "MAP %lu.%06lu %d 0x%llx 0x%lx 0x%lx 0x%lx %d\n",
231 secs, usec_rem, m->map_id,
232 (unsigned long long)m->phys, m->virt, m->len,
e0fd5c2f 233 0UL, 0);
bd8ac686
PP
234 break;
235 case MMIO_UNPROBE:
236 ret = trace_seq_printf(s,
237 "UNMAP %lu.%06lu %d 0x%lx %d\n",
e0fd5c2f 238 secs, usec_rem, m->map_id, 0UL, 0);
bd8ac686
PP
239 break;
240 default:
241 ret = trace_seq_printf(s, "map what?\n");
242 break;
243 }
244 if (ret)
07f4e4f7
FW
245 return TRACE_TYPE_HANDLED;
246 return TRACE_TYPE_PARTIAL_LINE;
bd8ac686
PP
247}
248
07f4e4f7 249static enum print_line_t mmio_print_mark(struct trace_iterator *iter)
fc5e27ae
PP
250{
251 struct trace_entry *entry = iter->ent;
777e208d
SR
252 struct print_entry *print = (struct print_entry *)entry;
253 const char *msg = print->buf;
fc5e27ae 254 struct trace_seq *s = &iter->seq;
3928a8a2 255 unsigned long long t = ns2usecs(iter->ts);
fc5e27ae
PP
256 unsigned long usec_rem = do_div(t, 1000000ULL);
257 unsigned secs = (unsigned long)t;
258 int ret;
259
260 /* The trailing newline must be in the message. */
261 ret = trace_seq_printf(s, "MARK %lu.%06lu %s", secs, usec_rem, msg);
262 if (!ret)
07f4e4f7 263 return TRACE_TYPE_PARTIAL_LINE;
fc5e27ae 264
777e208d 265 if (entry->flags & TRACE_FLAG_CONT)
fc5e27ae
PP
266 trace_seq_print_cont(s, iter);
267
07f4e4f7 268 return TRACE_TYPE_HANDLED;
fc5e27ae
PP
269}
270
07f4e4f7 271static enum print_line_t mmio_print_line(struct trace_iterator *iter)
bd8ac686
PP
272{
273 switch (iter->ent->type) {
274 case TRACE_MMIO_RW:
275 return mmio_print_rw(iter);
276 case TRACE_MMIO_MAP:
277 return mmio_print_map(iter);
fc5e27ae
PP
278 case TRACE_PRINT:
279 return mmio_print_mark(iter);
bd8ac686 280 default:
07f4e4f7 281 return TRACE_TYPE_HANDLED; /* ignore unknown entries */
bd8ac686 282 }
f984b51e
PP
283}
284
285static struct tracer mmio_tracer __read_mostly =
286{
287 .name = "mmiotrace",
288 .init = mmio_trace_init,
289 .reset = mmio_trace_reset,
bbf5b1a0 290 .start = mmio_trace_start,
d0a7e8ca
PP
291 .pipe_open = mmio_pipe_open,
292 .close = mmio_close,
293 .read = mmio_read,
bd8ac686 294 .print_line = mmio_print_line,
f984b51e
PP
295};
296
297__init static int init_mmio_trace(void)
298{
f984b51e
PP
299 return register_tracer(&mmio_tracer);
300}
301device_initcall(init_mmio_trace);
302
45dcd8b8
PP
303static void __trace_mmiotrace_rw(struct trace_array *tr,
304 struct trace_array_cpu *data,
305 struct mmiotrace_rw *rw)
306{
3928a8a2 307 struct ring_buffer_event *event;
777e208d 308 struct trace_mmiotrace_rw *entry;
45dcd8b8
PP
309 unsigned long irq_flags;
310
3928a8a2
SR
311 event = ring_buffer_lock_reserve(tr->buffer, sizeof(*entry),
312 &irq_flags);
313 if (!event)
314 return;
315 entry = ring_buffer_event_data(event);
38697053 316 tracing_generic_entry_update(&entry->ent, 0, preempt_count());
777e208d
SR
317 entry->ent.type = TRACE_MMIO_RW;
318 entry->rw = *rw;
3928a8a2 319 ring_buffer_unlock_commit(tr->buffer, event, irq_flags);
45dcd8b8
PP
320
321 trace_wake_up();
322}
323
bd8ac686 324void mmio_trace_rw(struct mmiotrace_rw *rw)
f984b51e
PP
325{
326 struct trace_array *tr = mmio_trace_array;
327 struct trace_array_cpu *data = tr->data[smp_processor_id()];
bd8ac686
PP
328 __trace_mmiotrace_rw(tr, data, rw);
329}
f984b51e 330
45dcd8b8
PP
331static void __trace_mmiotrace_map(struct trace_array *tr,
332 struct trace_array_cpu *data,
333 struct mmiotrace_map *map)
334{
3928a8a2 335 struct ring_buffer_event *event;
777e208d 336 struct trace_mmiotrace_map *entry;
45dcd8b8
PP
337 unsigned long irq_flags;
338
3928a8a2
SR
339 event = ring_buffer_lock_reserve(tr->buffer, sizeof(*entry),
340 &irq_flags);
341 if (!event)
342 return;
343 entry = ring_buffer_event_data(event);
38697053 344 tracing_generic_entry_update(&entry->ent, 0, preempt_count());
777e208d
SR
345 entry->ent.type = TRACE_MMIO_MAP;
346 entry->map = *map;
3928a8a2 347 ring_buffer_unlock_commit(tr->buffer, event, irq_flags);
45dcd8b8
PP
348
349 trace_wake_up();
350}
351
bd8ac686
PP
352void mmio_trace_mapping(struct mmiotrace_map *map)
353{
354 struct trace_array *tr = mmio_trace_array;
355 struct trace_array_cpu *data;
356
357 preempt_disable();
358 data = tr->data[smp_processor_id()];
359 __trace_mmiotrace_map(tr, data, map);
360 preempt_enable();
f984b51e 361}
9e57fb35
PP
362
363int mmio_trace_printk(const char *fmt, va_list args)
364{
1fd8f2a3 365 return trace_vprintk(0, -1, fmt, args);
9e57fb35 366}