blob: 80e503ef6136c208cef128006578ec7227a35678 [file] [log] [blame]
Pekka Paalanenf984b512008-05-12 21:20:57 +02001/*
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>
Pekka Paalanen13829532008-05-12 21:20:58 +020011#include <linux/pci.h>
Pekka Paalanen391b1702009-01-06 13:57:11 +020012#include <asm/atomic.h>
Pekka Paalanenf984b512008-05-12 21:20:57 +020013
14#include "trace.h"
15
Pekka Paalanend0a7e8c2008-05-12 21:21:02 +020016struct header_iter {
17 struct pci_dev *dev;
18};
19
Pekka Paalanenf984b512008-05-12 21:20:57 +020020static struct trace_array *mmio_trace_array;
Pekka Paalanen20392382008-05-12 21:21:02 +020021static bool overrun_detected;
Pekka Paalanen7ee17682008-11-23 21:24:30 +020022static unsigned long prev_overruns;
Pekka Paalanen391b1702009-01-06 13:57:11 +020023static atomic_t dropped_count;
Pekka Paalanenf984b512008-05-12 21:20:57 +020024
Pekka Paalanenbd8ac682008-05-12 21:20:57 +020025static void mmio_reset_data(struct trace_array *tr)
26{
Pekka Paalanen20392382008-05-12 21:21:02 +020027 overrun_detected = false;
Pekka Paalanen7ee17682008-11-23 21:24:30 +020028 prev_overruns = 0;
Pekka Paalanenbd8ac682008-05-12 21:20:57 +020029
Pekka J Enberg213cc062008-12-19 12:08:39 +020030 tracing_reset_online_cpus(tr);
Pekka Paalanenbd8ac682008-05-12 21:20:57 +020031}
Pekka Paalanenf984b512008-05-12 21:20:57 +020032
Frederic Weisbecker1c800252008-11-16 05:57:26 +010033static int mmio_trace_init(struct trace_array *tr)
Pekka Paalanenf984b512008-05-12 21:20:57 +020034{
35 pr_debug("in %s\n", __func__);
36 mmio_trace_array = tr;
Steven Rostedtc76f0692008-11-07 22:36:02 -050037
38 mmio_reset_data(tr);
39 enable_mmiotrace();
Frederic Weisbecker1c800252008-11-16 05:57:26 +010040 return 0;
Pekka Paalanenf984b512008-05-12 21:20:57 +020041}
42
43static void mmio_trace_reset(struct trace_array *tr)
44{
45 pr_debug("in %s\n", __func__);
Steven Rostedtc76f0692008-11-07 22:36:02 -050046
47 disable_mmiotrace();
Pekka Paalanenbd8ac682008-05-12 21:20:57 +020048 mmio_reset_data(tr);
49 mmio_trace_array = NULL;
Pekka Paalanenf984b512008-05-12 21:20:57 +020050}
51
Steven Rostedtbbf5b1a2008-11-07 22:36:02 -050052static void mmio_trace_start(struct trace_array *tr)
Pekka Paalanenf984b512008-05-12 21:20:57 +020053{
54 pr_debug("in %s\n", __func__);
Steven Rostedtbbf5b1a2008-11-07 22:36:02 -050055 mmio_reset_data(tr);
Pekka Paalanenbd8ac682008-05-12 21:20:57 +020056}
57
Pekka Paalanen13829532008-05-12 21:20:58 +020058static int mmio_print_pcidev(struct trace_seq *s, const struct pci_dev *dev)
59{
60 int ret = 0;
61 int i;
62 resource_size_t start, end;
63 const struct pci_driver *drv = pci_dev_driver(dev);
64
65 /* XXX: incomplete checks for trace_seq_printf() return value */
66 ret += trace_seq_printf(s, "PCIDEV %02x%02x %04x%04x %x",
67 dev->bus->number, dev->devfn,
68 dev->vendor, dev->device, dev->irq);
69 /*
70 * XXX: is pci_resource_to_user() appropriate, since we are
71 * supposed to interpret the __ioremap() phys_addr argument based on
72 * these printed values?
73 */
74 for (i = 0; i < 7; i++) {
75 pci_resource_to_user(dev, i, &dev->resource[i], &start, &end);
76 ret += trace_seq_printf(s, " %llx",
77 (unsigned long long)(start |
78 (dev->resource[i].flags & PCI_REGION_FLAG_MASK)));
79 }
80 for (i = 0; i < 7; i++) {
81 pci_resource_to_user(dev, i, &dev->resource[i], &start, &end);
82 ret += trace_seq_printf(s, " %llx",
83 dev->resource[i].start < dev->resource[i].end ?
84 (unsigned long long)(end - start) + 1 : 0);
85 }
86 if (drv)
87 ret += trace_seq_printf(s, " %s\n", drv->name);
88 else
89 ret += trace_seq_printf(s, " \n");
90 return ret;
91}
92
Pekka Paalanend0a7e8c2008-05-12 21:21:02 +020093static void destroy_header_iter(struct header_iter *hiter)
Pekka Paalanenbd8ac682008-05-12 21:20:57 +020094{
Pekka Paalanend0a7e8c2008-05-12 21:21:02 +020095 if (!hiter)
96 return;
97 pci_dev_put(hiter->dev);
98 kfree(hiter);
99}
100
101static void mmio_pipe_open(struct trace_iterator *iter)
102{
103 struct header_iter *hiter;
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200104 struct trace_seq *s = &iter->seq;
Pekka Paalanen13829532008-05-12 21:20:58 +0200105
106 trace_seq_printf(s, "VERSION 20070824\n");
107
Pekka Paalanend0a7e8c2008-05-12 21:21:02 +0200108 hiter = kzalloc(sizeof(*hiter), GFP_KERNEL);
109 if (!hiter)
110 return;
111
112 hiter->dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, NULL);
113 iter->private = hiter;
114}
115
116/* XXX: This is not called when the pipe is closed! */
117static void mmio_close(struct trace_iterator *iter)
118{
119 struct header_iter *hiter = iter->private;
120 destroy_header_iter(hiter);
121 iter->private = NULL;
122}
123
Pekka Paalanen20392382008-05-12 21:21:02 +0200124static unsigned long count_overruns(struct trace_iterator *iter)
125{
Pekka Paalanen391b1702009-01-06 13:57:11 +0200126 unsigned long cnt = atomic_xchg(&dropped_count, 0);
Pekka Paalanen7ee17682008-11-23 21:24:30 +0200127 unsigned long over = ring_buffer_overruns(iter->tr->buffer);
128
129 if (over > prev_overruns)
Pekka Paalanen391b1702009-01-06 13:57:11 +0200130 cnt += over - prev_overruns;
Pekka Paalanen7ee17682008-11-23 21:24:30 +0200131 prev_overruns = over;
Pekka Paalanen20392382008-05-12 21:21:02 +0200132 return cnt;
133}
134
Pekka Paalanend0a7e8c2008-05-12 21:21:02 +0200135static ssize_t mmio_read(struct trace_iterator *iter, struct file *filp,
136 char __user *ubuf, size_t cnt, loff_t *ppos)
137{
138 ssize_t ret;
139 struct header_iter *hiter = iter->private;
140 struct trace_seq *s = &iter->seq;
Pekka Paalanen20392382008-05-12 21:21:02 +0200141 unsigned long n;
142
143 n = count_overruns(iter);
144 if (n) {
145 /* XXX: This is later than where events were lost. */
146 trace_seq_printf(s, "MARK 0.000000 Lost %lu events.\n", n);
147 if (!overrun_detected)
148 pr_warning("mmiotrace has lost events.\n");
149 overrun_detected = true;
150 goto print_out;
151 }
Pekka Paalanend0a7e8c2008-05-12 21:21:02 +0200152
153 if (!hiter)
154 return 0;
155
156 mmio_print_pcidev(s, hiter->dev);
157 hiter->dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, hiter->dev);
158
159 if (!hiter->dev) {
160 destroy_header_iter(hiter);
161 iter->private = NULL;
162 }
163
Pekka Paalanen20392382008-05-12 21:21:02 +0200164print_out:
Pekka Paalanend0a7e8c2008-05-12 21:21:02 +0200165 ret = trace_seq_to_user(s, ubuf, cnt);
166 return (ret == -EBUSY) ? 0 : ret;
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200167}
168
Frederic Weisbecker07f4e4f2008-09-29 20:27:42 +0200169static enum print_line_t mmio_print_rw(struct trace_iterator *iter)
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200170{
171 struct trace_entry *entry = iter->ent;
Steven Rostedt7104f302008-10-01 10:52:51 -0400172 struct trace_mmiotrace_rw *field;
173 struct mmiotrace_rw *rw;
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200174 struct trace_seq *s = &iter->seq;
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400175 unsigned long long t = ns2usecs(iter->ts);
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200176 unsigned long usec_rem = do_div(t, 1000000ULL);
177 unsigned secs = (unsigned long)t;
178 int ret = 1;
179
Steven Rostedt7104f302008-10-01 10:52:51 -0400180 trace_assign_type(field, entry);
181 rw = &field->rw;
182
Steven Rostedt777e2082008-09-29 23:02:42 -0400183 switch (rw->opcode) {
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200184 case MMIO_READ:
185 ret = trace_seq_printf(s,
Pekka Paalanendee310d2008-05-12 21:21:03 +0200186 "R %d %lu.%06lu %d 0x%llx 0x%lx 0x%lx %d\n",
187 rw->width, secs, usec_rem, rw->map_id,
188 (unsigned long long)rw->phys,
Pekka Paalanen736ca612008-05-12 21:20:59 +0200189 rw->value, rw->pc, 0);
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200190 break;
191 case MMIO_WRITE:
192 ret = trace_seq_printf(s,
Pekka Paalanendee310d2008-05-12 21:21:03 +0200193 "W %d %lu.%06lu %d 0x%llx 0x%lx 0x%lx %d\n",
194 rw->width, secs, usec_rem, rw->map_id,
195 (unsigned long long)rw->phys,
Pekka Paalanen736ca612008-05-12 21:20:59 +0200196 rw->value, rw->pc, 0);
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200197 break;
198 case MMIO_UNKNOWN_OP:
199 ret = trace_seq_printf(s,
Pekka Paalanendee310d2008-05-12 21:21:03 +0200200 "UNKNOWN %lu.%06lu %d 0x%llx %02x,%02x,%02x 0x%lx %d\n",
201 secs, usec_rem, rw->map_id,
202 (unsigned long long)rw->phys,
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200203 (rw->value >> 16) & 0xff, (rw->value >> 8) & 0xff,
Pekka Paalanen736ca612008-05-12 21:20:59 +0200204 (rw->value >> 0) & 0xff, rw->pc, 0);
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200205 break;
206 default:
207 ret = trace_seq_printf(s, "rw what?\n");
208 break;
209 }
210 if (ret)
Frederic Weisbecker07f4e4f2008-09-29 20:27:42 +0200211 return TRACE_TYPE_HANDLED;
212 return TRACE_TYPE_PARTIAL_LINE;
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200213}
214
Frederic Weisbecker07f4e4f2008-09-29 20:27:42 +0200215static enum print_line_t mmio_print_map(struct trace_iterator *iter)
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200216{
217 struct trace_entry *entry = iter->ent;
Steven Rostedt7104f302008-10-01 10:52:51 -0400218 struct trace_mmiotrace_map *field;
219 struct mmiotrace_map *m;
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200220 struct trace_seq *s = &iter->seq;
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400221 unsigned long long t = ns2usecs(iter->ts);
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200222 unsigned long usec_rem = do_div(t, 1000000ULL);
223 unsigned secs = (unsigned long)t;
Frederic Weisbecker07f4e4f2008-09-29 20:27:42 +0200224 int ret;
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200225
Steven Rostedt7104f302008-10-01 10:52:51 -0400226 trace_assign_type(field, entry);
227 m = &field->map;
228
Steven Rostedt777e2082008-09-29 23:02:42 -0400229 switch (m->opcode) {
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200230 case MMIO_PROBE:
231 ret = trace_seq_printf(s,
Pekka Paalanendee310d2008-05-12 21:21:03 +0200232 "MAP %lu.%06lu %d 0x%llx 0x%lx 0x%lx 0x%lx %d\n",
233 secs, usec_rem, m->map_id,
234 (unsigned long long)m->phys, m->virt, m->len,
Pekka Paalanene0fd5c22008-05-12 21:21:02 +0200235 0UL, 0);
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200236 break;
237 case MMIO_UNPROBE:
238 ret = trace_seq_printf(s,
239 "UNMAP %lu.%06lu %d 0x%lx %d\n",
Pekka Paalanene0fd5c22008-05-12 21:21:02 +0200240 secs, usec_rem, m->map_id, 0UL, 0);
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200241 break;
242 default:
243 ret = trace_seq_printf(s, "map what?\n");
244 break;
245 }
246 if (ret)
Frederic Weisbecker07f4e4f2008-09-29 20:27:42 +0200247 return TRACE_TYPE_HANDLED;
248 return TRACE_TYPE_PARTIAL_LINE;
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200249}
250
Frederic Weisbecker07f4e4f2008-09-29 20:27:42 +0200251static enum print_line_t mmio_print_mark(struct trace_iterator *iter)
Pekka Paalanenfc5e27a2008-09-16 22:02:27 +0300252{
253 struct trace_entry *entry = iter->ent;
Steven Rostedt777e2082008-09-29 23:02:42 -0400254 struct print_entry *print = (struct print_entry *)entry;
255 const char *msg = print->buf;
Pekka Paalanenfc5e27a2008-09-16 22:02:27 +0300256 struct trace_seq *s = &iter->seq;
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400257 unsigned long long t = ns2usecs(iter->ts);
Pekka Paalanenfc5e27a2008-09-16 22:02:27 +0300258 unsigned long usec_rem = do_div(t, 1000000ULL);
259 unsigned secs = (unsigned long)t;
260 int ret;
261
262 /* The trailing newline must be in the message. */
263 ret = trace_seq_printf(s, "MARK %lu.%06lu %s", secs, usec_rem, msg);
264 if (!ret)
Frederic Weisbecker07f4e4f2008-09-29 20:27:42 +0200265 return TRACE_TYPE_PARTIAL_LINE;
Pekka Paalanenfc5e27a2008-09-16 22:02:27 +0300266
Steven Rostedt777e2082008-09-29 23:02:42 -0400267 if (entry->flags & TRACE_FLAG_CONT)
Pekka Paalanenfc5e27a2008-09-16 22:02:27 +0300268 trace_seq_print_cont(s, iter);
269
Frederic Weisbecker07f4e4f2008-09-29 20:27:42 +0200270 return TRACE_TYPE_HANDLED;
Pekka Paalanenfc5e27a2008-09-16 22:02:27 +0300271}
272
Frederic Weisbecker07f4e4f2008-09-29 20:27:42 +0200273static enum print_line_t mmio_print_line(struct trace_iterator *iter)
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200274{
275 switch (iter->ent->type) {
276 case TRACE_MMIO_RW:
277 return mmio_print_rw(iter);
278 case TRACE_MMIO_MAP:
279 return mmio_print_map(iter);
Pekka Paalanenfc5e27a2008-09-16 22:02:27 +0300280 case TRACE_PRINT:
281 return mmio_print_mark(iter);
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200282 default:
Frederic Weisbecker07f4e4f2008-09-29 20:27:42 +0200283 return TRACE_TYPE_HANDLED; /* ignore unknown entries */
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200284 }
Pekka Paalanenf984b512008-05-12 21:20:57 +0200285}
286
287static struct tracer mmio_tracer __read_mostly =
288{
289 .name = "mmiotrace",
290 .init = mmio_trace_init,
291 .reset = mmio_trace_reset,
Steven Rostedtbbf5b1a2008-11-07 22:36:02 -0500292 .start = mmio_trace_start,
Pekka Paalanend0a7e8c2008-05-12 21:21:02 +0200293 .pipe_open = mmio_pipe_open,
294 .close = mmio_close,
295 .read = mmio_read,
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200296 .print_line = mmio_print_line,
Pekka Paalanenf984b512008-05-12 21:20:57 +0200297};
298
299__init static int init_mmio_trace(void)
300{
Pekka Paalanenf984b512008-05-12 21:20:57 +0200301 return register_tracer(&mmio_tracer);
302}
303device_initcall(init_mmio_trace);
304
Pekka Paalanen45dcd8b2008-09-16 21:56:41 +0300305static void __trace_mmiotrace_rw(struct trace_array *tr,
306 struct trace_array_cpu *data,
307 struct mmiotrace_rw *rw)
308{
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400309 struct ring_buffer_event *event;
Steven Rostedt777e2082008-09-29 23:02:42 -0400310 struct trace_mmiotrace_rw *entry;
Pekka Paalanen45dcd8b2008-09-16 21:56:41 +0300311 unsigned long irq_flags;
312
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400313 event = ring_buffer_lock_reserve(tr->buffer, sizeof(*entry),
314 &irq_flags);
Pekka Paalanen391b1702009-01-06 13:57:11 +0200315 if (!event) {
316 atomic_inc(&dropped_count);
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400317 return;
Pekka Paalanen391b1702009-01-06 13:57:11 +0200318 }
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400319 entry = ring_buffer_event_data(event);
Steven Rostedt38697052008-10-01 13:14:09 -0400320 tracing_generic_entry_update(&entry->ent, 0, preempt_count());
Steven Rostedt777e2082008-09-29 23:02:42 -0400321 entry->ent.type = TRACE_MMIO_RW;
322 entry->rw = *rw;
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400323 ring_buffer_unlock_commit(tr->buffer, event, irq_flags);
Pekka Paalanen45dcd8b2008-09-16 21:56:41 +0300324
325 trace_wake_up();
326}
327
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200328void mmio_trace_rw(struct mmiotrace_rw *rw)
Pekka Paalanenf984b512008-05-12 21:20:57 +0200329{
330 struct trace_array *tr = mmio_trace_array;
331 struct trace_array_cpu *data = tr->data[smp_processor_id()];
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200332 __trace_mmiotrace_rw(tr, data, rw);
333}
Pekka Paalanenf984b512008-05-12 21:20:57 +0200334
Pekka Paalanen45dcd8b2008-09-16 21:56:41 +0300335static void __trace_mmiotrace_map(struct trace_array *tr,
336 struct trace_array_cpu *data,
337 struct mmiotrace_map *map)
338{
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400339 struct ring_buffer_event *event;
Steven Rostedt777e2082008-09-29 23:02:42 -0400340 struct trace_mmiotrace_map *entry;
Pekka Paalanen45dcd8b2008-09-16 21:56:41 +0300341 unsigned long irq_flags;
342
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400343 event = ring_buffer_lock_reserve(tr->buffer, sizeof(*entry),
344 &irq_flags);
Pekka Paalanen391b1702009-01-06 13:57:11 +0200345 if (!event) {
346 atomic_inc(&dropped_count);
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400347 return;
Pekka Paalanen391b1702009-01-06 13:57:11 +0200348 }
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400349 entry = ring_buffer_event_data(event);
Steven Rostedt38697052008-10-01 13:14:09 -0400350 tracing_generic_entry_update(&entry->ent, 0, preempt_count());
Steven Rostedt777e2082008-09-29 23:02:42 -0400351 entry->ent.type = TRACE_MMIO_MAP;
352 entry->map = *map;
Steven Rostedt3928a8a2008-09-29 23:02:41 -0400353 ring_buffer_unlock_commit(tr->buffer, event, irq_flags);
Pekka Paalanen45dcd8b2008-09-16 21:56:41 +0300354
355 trace_wake_up();
356}
357
Pekka Paalanenbd8ac682008-05-12 21:20:57 +0200358void mmio_trace_mapping(struct mmiotrace_map *map)
359{
360 struct trace_array *tr = mmio_trace_array;
361 struct trace_array_cpu *data;
362
363 preempt_disable();
364 data = tr->data[smp_processor_id()];
365 __trace_mmiotrace_map(tr, data, map);
366 preempt_enable();
Pekka Paalanenf984b512008-05-12 21:20:57 +0200367}
Pekka Paalanen9e57fb32008-09-16 22:00:34 +0300368
369int mmio_trace_printk(const char *fmt, va_list args)
370{
Frederic Weisbecker1fd8f2a2008-12-03 23:45:11 +0100371 return trace_vprintk(0, -1, fmt, args);
Pekka Paalanen9e57fb32008-09-16 22:00:34 +0300372}