[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 <linux/time.h>

#include <asm/atomic.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 atomic_t dropped_count;

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 = atomic_xchg(&dropped_count, 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, USEC_PER_SEC);
	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 %u.%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 %u.%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 %u.%06lu %d 0x%llx %02lx,%02lx,"
			"%02lx 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, USEC_PER_SEC);
	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 %u.%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 %u.%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, USEC_PER_SEC);
	unsigned secs		= (unsigned long)t;
	int ret;

	/* The trailing newline must be in the message. */
	ret = trace_seq_printf(s, "MARK %u.%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 ftrace_event_call *call = &event_mmiotrace_rw;
	struct ring_buffer *buffer = tr->buffer;
	struct ring_buffer_event *event;
	struct trace_mmiotrace_rw *entry;
	int pc = preempt_count();

	event = trace_buffer_lock_reserve(buffer, TRACE_MMIO_RW,
					  sizeof(*entry), 0, pc);
	if (!event) {
		atomic_inc(&dropped_count);
		return;
	}
	entry	= ring_buffer_event_data(event);
	entry->rw			= *rw;

	if (!filter_check_discard(call, entry, buffer, event))
		trace_buffer_unlock_commit(buffer, event, 0, pc);
}

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 ftrace_event_call *call = &event_mmiotrace_map;
	struct ring_buffer *buffer = tr->buffer;
	struct ring_buffer_event *event;
	struct trace_mmiotrace_map *entry;
	int pc = preempt_count();

	event = trace_buffer_lock_reserve(buffer, TRACE_MMIO_MAP,
					  sizeof(*entry), 0, pc);
	if (!event) {
		atomic_inc(&dropped_count);
		return;
	}
	entry	= ring_buffer_event_data(event);
	entry->map			= *map;

	if (!filter_check_discard(call, entry, buffer, event))
		trace_buffer_unlock_commit(buffer, event, 0, pc);
}

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