[deliverable/linux.git] / kernel / trace / trace_mmiotrace.c

/*
 * Memory mapped I/O tracing
 *
 * Copyright (C) 2008 Pekka Paalanen <pq@iki.fi>
 */

#define DEBUG 1

#include <linux/kernel.h>
#include <linux/mmiotrace.h>
#include <linux/pci.h>

#include "trace.h"
#include "trace_output.h"

struct header_iter {
	struct pci_dev *dev;
};

static struct trace_array *mmio_trace_array;
static bool overrun_detected;
static unsigned long prev_overruns;

static void mmio_reset_data(struct trace_array *tr)
{
	overrun_detected = false;
	prev_overruns = 0;

	tracing_reset_online_cpus(tr);
}

static int mmio_trace_init(struct trace_array *tr)
{
	pr_debug("in %s\n", __func__);
	mmio_trace_array = tr;

	mmio_reset_data(tr);
	enable_mmiotrace();
	return 0;
}

static void mmio_trace_reset(struct trace_array *tr)
{
	pr_debug("in %s\n", __func__);

	disable_mmiotrace();
	mmio_reset_data(tr);
	mmio_trace_array = NULL;
}

static void mmio_trace_start(struct trace_array *tr)
{
	pr_debug("in %s\n", __func__);
	mmio_reset_data(tr);
}

static int mmio_print_pcidev(struct trace_seq *s, const struct pci_dev *dev)
{
	int ret = 0;
	int i;
	resource_size_t start, end;
	const struct pci_driver *drv = pci_dev_driver(dev);

	/* XXX: incomplete checks for trace_seq_printf() return value */
	ret += trace_seq_printf(s, "PCIDEV %02x%02x %04x%04x %x",
				dev->bus->number, dev->devfn,
				dev->vendor, dev->device, dev->irq);
	/*
	 * XXX: is pci_resource_to_user() appropriate, since we are
	 * supposed to interpret the __ioremap() phys_addr argument based on
	 * these printed values?
	 */
	for (i = 0; i < 7; i++) {
		pci_resource_to_user(dev, i, &dev->resource[i], &start, &end);
		ret += trace_seq_printf(s, " %llx",
			(unsigned long long)(start |
			(dev->resource[i].flags & PCI_REGION_FLAG_MASK)));
	}
	for (i = 0; i < 7; i++) {
		pci_resource_to_user(dev, i, &dev->resource[i], &start, &end);
		ret += trace_seq_printf(s, " %llx",
			dev->resource[i].start < dev->resource[i].end ?
			(unsigned long long)(end - start) + 1 : 0);
	}
	if (drv)
		ret += trace_seq_printf(s, " %s\n", drv->name);
	else
		ret += trace_seq_printf(s, " \n");
	return ret;
}

static void destroy_header_iter(struct header_iter *hiter)
{
	if (!hiter)
		return;
	pci_dev_put(hiter->dev);
	kfree(hiter);
}

static void mmio_pipe_open(struct trace_iterator *iter)
{
	struct header_iter *hiter;
	struct trace_seq *s = &iter->seq;

	trace_seq_printf(s, "VERSION 20070824\n");

	hiter = kzalloc(sizeof(*hiter), GFP_KERNEL);
	if (!hiter)
		return;

	hiter->dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, NULL);
	iter->private = hiter;
}

/* XXX: This is not called when the pipe is closed! */
static void mmio_close(struct trace_iterator *iter)
{
	struct header_iter *hiter = iter->private;
	destroy_header_iter(hiter);
	iter->private = NULL;
}

static unsigned long count_overruns(struct trace_iterator *iter)
{
	unsigned long cnt = 0;
	unsigned long over = ring_buffer_overruns(iter->tr->buffer);

	if (over > prev_overruns)
		cnt = over - prev_overruns;
	prev_overruns = over;
	return cnt;
}

static ssize_t mmio_read(struct trace_iterator *iter, struct file *filp,
				char __user *ubuf, size_t cnt, loff_t *ppos)
{
	ssize_t ret;
	struct header_iter *hiter = iter->private;
	struct trace_seq *s = &iter->seq;
	unsigned long n;

	n = count_overruns(iter);
	if (n) {
		/* XXX: This is later than where events were lost. */
		trace_seq_printf(s, "MARK 0.000000 Lost %lu events.\n", n);
		if (!overrun_detected)
			pr_warning("mmiotrace has lost events.\n");
		overrun_detected = true;
		goto print_out;
	}

	if (!hiter)
		return 0;

	mmio_print_pcidev(s, hiter->dev);
	hiter->dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, hiter->dev);

	if (!hiter->dev) {
		destroy_header_iter(hiter);
		iter->private = NULL;
	}

print_out:
	ret = trace_seq_to_user(s, ubuf, cnt);
	return (ret == -EBUSY) ? 0 : ret;
}

static enum print_line_t mmio_print_rw(struct trace_iterator *iter)
{
	struct trace_entry *entry = iter->ent;
	struct trace_mmiotrace_rw *field;
	struct mmiotrace_rw *rw;
	struct trace_seq *s	= &iter->seq;
	unsigned long long t	= ns2usecs(iter->ts);
	unsigned long usec_rem	= do_div(t, 1000000ULL);
	unsigned secs		= (unsigned long)t;
	int ret = 1;

	trace_assign_type(field, entry);
	rw = &field->rw;

	switch (rw->opcode) {
	case MMIO_READ:
		ret = trace_seq_printf(s,
			"R %d %lu.%06lu %d 0x%llx 0x%lx 0x%lx %d\n",
			rw->width, secs, usec_rem, rw->map_id,
			(unsigned long long)rw->phys,
			rw->value, rw->pc, 0);
		break;
	case MMIO_WRITE:
		ret = trace_seq_printf(s,
			"W %d %lu.%06lu %d 0x%llx 0x%lx 0x%lx %d\n",
			rw->width, secs, usec_rem, rw->map_id,
			(unsigned long long)rw->phys,
			rw->value, rw->pc, 0);
		break;
	case MMIO_UNKNOWN_OP:
		ret = trace_seq_printf(s,
			"UNKNOWN %lu.%06lu %d 0x%llx %02x,%02x,%02x 0x%lx %d\n",
			secs, usec_rem, rw->map_id,
			(unsigned long long)rw->phys,
			(rw->value >> 16) & 0xff, (rw->value >> 8) & 0xff,
			(rw->value >> 0) & 0xff, rw->pc, 0);
		break;
	default:
		ret = trace_seq_printf(s, "rw what?\n");
		break;
	}
	if (ret)
		return TRACE_TYPE_HANDLED;
	return TRACE_TYPE_PARTIAL_LINE;
}

static enum print_line_t mmio_print_map(struct trace_iterator *iter)
{
	struct trace_entry *entry = iter->ent;
	struct trace_mmiotrace_map *field;
	struct mmiotrace_map *m;
	struct trace_seq *s	= &iter->seq;
	unsigned long long t	= ns2usecs(iter->ts);
	unsigned long usec_rem	= do_div(t, 1000000ULL);
	unsigned secs		= (unsigned long)t;
	int ret;

	trace_assign_type(field, entry);
	m = &field->map;

	switch (m->opcode) {
	case MMIO_PROBE:
		ret = trace_seq_printf(s,
			"MAP %lu.%06lu %d 0x%llx 0x%lx 0x%lx 0x%lx %d\n",
			secs, usec_rem, m->map_id,
			(unsigned long long)m->phys, m->virt, m->len,
			0UL, 0);
		break;
	case MMIO_UNPROBE:
		ret = trace_seq_printf(s,
			"UNMAP %lu.%06lu %d 0x%lx %d\n",
			secs, usec_rem, m->map_id, 0UL, 0);
		break;
	default:
		ret = trace_seq_printf(s, "map what?\n");
		break;
	}
	if (ret)
		return TRACE_TYPE_HANDLED;
	return TRACE_TYPE_PARTIAL_LINE;
}

static enum print_line_t mmio_print_mark(struct trace_iterator *iter)
{
	struct trace_entry *entry = iter->ent;
	struct print_entry *print = (struct print_entry *)entry;
	const char *msg		= print->buf;
	struct trace_seq *s	= &iter->seq;
	unsigned long long t	= ns2usecs(iter->ts);
	unsigned long usec_rem	= do_div(t, 1000000ULL);
	unsigned secs		= (unsigned long)t;
	int ret;

	/* The trailing newline must be in the message. */
	ret = trace_seq_printf(s, "MARK %lu.%06lu %s", secs, usec_rem, msg);
	if (!ret)
		return TRACE_TYPE_PARTIAL_LINE;

	return TRACE_TYPE_HANDLED;
}

static enum print_line_t mmio_print_line(struct trace_iterator *iter)
{
	switch (iter->ent->type) {
	case TRACE_MMIO_RW:
		return mmio_print_rw(iter);
	case TRACE_MMIO_MAP:
		return mmio_print_map(iter);
	case TRACE_PRINT:
		return mmio_print_mark(iter);
	default:
		return TRACE_TYPE_HANDLED; /* ignore unknown entries */
	}
}

static struct tracer mmio_tracer __read_mostly =
{
	.name		= "mmiotrace",
	.init		= mmio_trace_init,
	.reset		= mmio_trace_reset,
	.start		= mmio_trace_start,
	.pipe_open	= mmio_pipe_open,
	.close		= mmio_close,
	.read		= mmio_read,
	.print_line	= mmio_print_line,
};

__init static int init_mmio_trace(void)
{
	return register_tracer(&mmio_tracer);
}
device_initcall(init_mmio_trace);

static void __trace_mmiotrace_rw(struct trace_array *tr,
				struct trace_array_cpu *data,
				struct mmiotrace_rw *rw)
{
	struct ring_buffer_event *event;
	struct trace_mmiotrace_rw *entry;
	unsigned long irq_flags;

	event	= ring_buffer_lock_reserve(tr->buffer, sizeof(*entry),
					   &irq_flags);
	if (!event)
		return;
	entry	= ring_buffer_event_data(event);
	tracing_generic_entry_update(&entry->ent, 0, preempt_count());
	entry->ent.type			= TRACE_MMIO_RW;
	entry->rw			= *rw;
	ring_buffer_unlock_commit(tr->buffer, event, irq_flags);

	trace_wake_up();
}

void mmio_trace_rw(struct mmiotrace_rw *rw)
{
	struct trace_array *tr = mmio_trace_array;
	struct trace_array_cpu *data = tr->data[smp_processor_id()];
	__trace_mmiotrace_rw(tr, data, rw);
}

static void __trace_mmiotrace_map(struct trace_array *tr,
				struct trace_array_cpu *data,
				struct mmiotrace_map *map)
{
	struct ring_buffer_event *event;
	struct trace_mmiotrace_map *entry;
	unsigned long irq_flags;

	event	= ring_buffer_lock_reserve(tr->buffer, sizeof(*entry),
					   &irq_flags);
	if (!event)
		return;
	entry	= ring_buffer_event_data(event);
	tracing_generic_entry_update(&entry->ent, 0, preempt_count());
	entry->ent.type			= TRACE_MMIO_MAP;
	entry->map			= *map;
	ring_buffer_unlock_commit(tr->buffer, event, irq_flags);

	trace_wake_up();
}

void mmio_trace_mapping(struct mmiotrace_map *map)
{
	struct trace_array *tr = mmio_trace_array;
	struct trace_array_cpu *data;

	preempt_disable();
	data = tr->data[smp_processor_id()];
	__trace_mmiotrace_map(tr, data, map);
	preempt_enable();
}

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