drivers/memory_debug/ddr_tool/dmc_c3.c - manifest_repos/amlogic-driver - Git at Google

 // SPDX-License-Identifier: (GPL-2.0+ OR MIT)
 /*
  * Copyright (c) 2019 Amlogic, Inc. All rights reserved.
  */

 #include <linux/cdev.h>
 #include <linux/types.h>
 #include <linux/fs.h>
 #include <linux/device.h>
 #include <linux/slab.h>
 #include <linux/delay.h>
 #include <linux/uaccess.h>
 #include <linux/sched.h>
 #include <linux/platform_device.h>
 #include <linux/of.h>
 #include <linux/of_fdt.h>
 #include <linux/irqreturn.h>
 #include <linux/module.h>
 #include <linux/mm.h>

 #include <linux/cpu.h>
 #include <linux/smp.h>
 #include <linux/kallsyms.h>
 #include <linux/of_irq.h>
 #include <linux/interrupt.h>
 #include <linux/sched/clock.h>
 #include <linux/amlogic/page_trace.h>
 #include "ddr_port.h"
 #include "dmc_monitor.h"

 #define DMC_PROT0_STA		((0x00d0  << 2))
 #define DMC_PROT0_EDA		((0x00d1  << 2))
 #define DMC_PROT0_CTRL		((0x00d2  << 2))
 #define DMC_PROT0_CTRL1		((0x00d3  << 2))

 #define DMC_PROT1_STA		((0x00d4  << 2))
 #define DMC_PROT1_EDA		((0x00d5  << 2))
 #define DMC_PROT1_CTRL		((0x00d6  << 2))
 #define DMC_PROT1_CTRL1		((0x00d7  << 2))

 #define DMC_PROT_VIO_0		((0x00d8  << 2))
 #define DMC_PROT_VIO_1		((0x00d9  << 2))

 #define DMC_PROT_VIO_2		((0x00da  << 2))
 #define DMC_PROT_VIO_3		((0x00db  << 2))

 #define DMC_PROT_IRQ_CTRL	((0x00dc  << 2))
 #define DMC_IRQ_STS		((0x00cf  << 2))

 #define DMC_SEC_STATUS		((0x00fa  << 2))
 #define DMC_VIO_ADDR0		((0x00fb  << 2))
 #define DMC_VIO_ADDR1		((0x00fc  << 2))
 #define DMC_VIO_ADDR2		((0x00fd  << 2))
 #define DMC_VIO_ADDR3		((0x00fe  << 2))

 #define DMC_VIO_PROT0	BIT(20)
 #define DMC_VIO_PROT1	BIT(21)

 static size_t c3_dmc_dump_reg(char *buf)
 {
 	size_t sz = 0, i;
 	unsigned long val;
 	void *io = dmc_mon->mon_comm[0].io_mem;

 	for (i = 0; i < 2; i++) {
 		val = dmc_prot_rw(io, DMC_PROT0_STA + (i * 16), 0, DMC_READ);
 		sz += sprintf(buf + sz, "DMC_PROT%zu_STA:%lx\n", i, val);
 		val = dmc_prot_rw(io, DMC_PROT0_EDA + (i * 16), 0, DMC_READ);
 		sz += sprintf(buf + sz, "DMC_PROT%zu_EDA:%lx\n", i, val);
 		val = dmc_prot_rw(io, DMC_PROT0_CTRL + (i * 16), 0, DMC_READ);
 		sz += sprintf(buf + sz, "DMC_PROT%zu_CTRL:%lx\n", i, val);
 		val = dmc_prot_rw(io, DMC_PROT0_CTRL1 + (i * 16), 0, DMC_READ);
 		sz += sprintf(buf + sz, "DMC_PROT%zu_CTRL1:%lx\n", i, val);
 	}
 	for (i = 0; i < 4; i++) {
 		val = dmc_prot_rw(io, DMC_PROT_VIO_0 + (i << 2), 0, DMC_READ);
 		sz += sprintf(buf + sz, "DMC_PROT_VIO_%zu:%lx\n", i, val);
 	}
 	val = dmc_prot_rw(io, DMC_PROT_IRQ_CTRL, 0, DMC_READ);
 	sz += sprintf(buf + sz, "DMC_PROT_IRQ_CTRL:%lx\n", val);
 	val = dmc_prot_rw(io, DMC_IRQ_STS, 0, DMC_READ);
 	sz += sprintf(buf + sz, "DMC_IRQ_STS:%lx\n", val);

 	return sz;
 }

 static int check_violation(struct dmc_monitor *mon, void *data)
 {
 	int ret = -1;
 	unsigned long irqreg;
 	struct page *page;
 	struct page_trace *trace;
 	struct dmc_mon_comm *mon_comm = (struct dmc_mon_comm *)data;

 	irqreg = dmc_prot_rw(mon_comm->io_mem, DMC_IRQ_STS, 0, DMC_READ);
 	if (irqreg & DMC_WRITE_VIOLATION) {
 		mon_comm->time = sched_clock();
 		mon_comm->status = dmc_prot_rw(mon_comm->io_mem, DMC_PROT_VIO_1, 0, DMC_READ);
 		/* combine address */
 		mon_comm->addr = dmc_prot_rw(mon_comm->io_mem, DMC_PROT_VIO_0, 0, DMC_READ);
 		mon_comm->rw = 'w';
 		page = phys_to_page(mon_comm->addr);
 		trace = dmc_find_page_base(page);
 		if (trace)
 			mon_comm->trace = *trace;
 		else
 			mon_comm->trace.ip_data = IP_INVALID;
 		mon_comm->page_flags = page->flags & PAGEFLAGS_MASK;
 		ret = 0;
 	} else if (irqreg & DMC_READ_VIOLATION) {
 		mon_comm->time = sched_clock();
 		mon_comm->status = dmc_prot_rw(mon_comm->io_mem, DMC_PROT_VIO_3, 0, DMC_READ);
 		mon_comm->addr = dmc_prot_rw(mon_comm->io_mem, DMC_PROT_VIO_2, 0, DMC_READ);
 		mon_comm->rw = 'r';
 		page = phys_to_page(mon_comm->addr);
 		trace = dmc_find_page_base(page);
 		if (trace)
 			mon_comm->trace = *trace;
 		else
 			mon_comm->trace.ip_data = IP_INVALID;
 		mon_comm->page_flags = page->flags & PAGEFLAGS_MASK;
 		ret = 0;
 	}

 	return ret;
 }

 static int c3_dmc_mon_irq(struct dmc_monitor *mon, void *data, char clear)
 {
 	unsigned long irqreg;
 	struct dmc_mon_comm *mon_comm = (struct dmc_mon_comm *)data;

 	if (clear) {
 		/* clear irq */
 		irqreg = dmc_prot_rw(mon_comm->io_mem, DMC_PROT_IRQ_CTRL, 0, DMC_READ);
 		if (dmc_mon->debug & DMC_DEBUG_SUSPEND)
 			irqreg &= ~0x04;
 		else
 			irqreg |= 0x04;		/* en */
 		dmc_prot_rw(mon_comm->io_mem, DMC_PROT_IRQ_CTRL, irqreg, DMC_WRITE);
 	} else {
 		return check_violation(mon, data);
 	}

 	return 0;
 }

 static void c3_dmc_vio_to_port(void *data, unsigned long *vio_bit)
 {
 	int port = 0, subport = 0;
 	struct dmc_mon_comm *mon_comm = (struct dmc_mon_comm *)data;

 	*vio_bit = DMC_VIO_PROT1 | DMC_VIO_PROT0;
 	port = mon_comm->status & 0xff;
 	subport = (mon_comm->status >> 8) & 0x7f;

 	mon_comm->port.name = to_ports(port);
 	if (!mon_comm->port.name)
 		sprintf(mon_comm->port.id, "%d", port);

 	mon_comm->sub.name = to_sub_ports_name(port, subport, mon_comm->rw);
 	if (!mon_comm->sub.name)
 		sprintf(mon_comm->sub.id, "%d", subport);
 }

 static int c3_dmc_mon_set(struct dmc_monitor *mon)
 {
 	unsigned long start, end, val;
 	unsigned int dev1, dev2;
 	void *io = dmc_mon->mon_comm[0].io_mem;

 	if (!dmc_mon->device)
 		return 0;

 	start = mon->addr_start >> PAGE_SHIFT;
 	end   = ALIGN_DOWN(mon->addr_end, PAGE_SIZE);
 	end   = end >> PAGE_SHIFT;
 	dev1  = mon->device & 0xffffffff;
 	dev2  = mon->device >> 32;

 	dmc_prot_rw(io, DMC_PROT_IRQ_CTRL, 0x3, DMC_WRITE);

 	if (dev1) {
 		dmc_prot_rw(io, DMC_PROT0_STA, start, DMC_WRITE);
 		dmc_prot_rw(io, DMC_PROT0_EDA, end, DMC_WRITE);
 	} else {
 		dmc_prot_rw(io, DMC_PROT0_STA, 0, DMC_WRITE);
 		dmc_prot_rw(io, DMC_PROT0_EDA, 0, DMC_WRITE);
 	}

 	/* when set exclude, PROT1 can not be used */
 	if (dev2 && (dmc_mon->debug & DMC_DEBUG_INCLUDE)) {
 		dmc_prot_rw(io, DMC_PROT1_STA, start, DMC_WRITE);
 		dmc_prot_rw(io, DMC_PROT1_EDA, end, DMC_WRITE);
 	} else {
 		dmc_prot_rw(io, DMC_PROT1_STA, 0UL, DMC_WRITE);
 		dmc_prot_rw(io, DMC_PROT1_EDA, 0UL, DMC_WRITE);
 	}

 	val = 0xf;
 	if (dmc_mon->debug & DMC_DEBUG_WRITE)
 		val |= (1 << 27);

 	if (dmc_mon->debug & DMC_DEBUG_READ)
 		val |= (1 << 26);

 	if (dmc_mon->debug & DMC_DEBUG_INCLUDE)
 		val |= (1 << 8);
 	else
 		val &= ~(1 << 8);

 	if (dev1) {
 		dmc_prot_rw(io, DMC_PROT0_CTRL,  val,  DMC_WRITE);
 		dmc_prot_rw(io, DMC_PROT0_CTRL1, dev1, DMC_WRITE);
 	} else {
 		dmc_prot_rw(io, DMC_PROT0_CTRL,  0UL,  DMC_WRITE);
 		dmc_prot_rw(io, DMC_PROT0_CTRL1, 0UL, DMC_WRITE);
 	}

 	/* when set exclude, PROT1 can not be used */
 	if (dev2 && (dmc_mon->debug & DMC_DEBUG_INCLUDE)) {
 		dmc_prot_rw(io, DMC_PROT1_CTRL,  val,  DMC_WRITE);
 		dmc_prot_rw(io, DMC_PROT1_CTRL1, dev2, DMC_WRITE);
 	} else {
 		dmc_prot_rw(io, DMC_PROT1_CTRL,  0UL,  DMC_WRITE);
 		dmc_prot_rw(io, DMC_PROT1_CTRL1, 0UL, DMC_WRITE);
 	}

 	if (dmc_mon->debug & DMC_DEBUG_SUSPEND)
 		val = 0X3;
 	else
 		val = 0X7;
 	dmc_prot_rw(io, DMC_PROT_IRQ_CTRL, val, DMC_WRITE);

 	pr_emerg("range:%08lx - %08lx, device:%16llx\n",
 		 mon->addr_start, mon->addr_end, mon->device);
 	return 0;
 }

 void c3_dmc_mon_disable(struct dmc_monitor *mon)
 {
 	void *io = dmc_mon->mon_comm[0].io_mem;

 	dmc_prot_rw(io, DMC_PROT0_STA,   0, DMC_WRITE);
 	dmc_prot_rw(io, DMC_PROT0_EDA,   0, DMC_WRITE);
 	dmc_prot_rw(io, DMC_PROT1_STA,   0, DMC_WRITE);
 	dmc_prot_rw(io, DMC_PROT1_EDA,   0, DMC_WRITE);
 	dmc_prot_rw(io, DMC_PROT0_CTRL,  0, DMC_WRITE);
 	dmc_prot_rw(io, DMC_PROT0_CTRL1, 0, DMC_WRITE);
 	dmc_prot_rw(io, DMC_PROT1_CTRL,  0, DMC_WRITE);
 	dmc_prot_rw(io, DMC_PROT1_CTRL1, 0, DMC_WRITE);
 	mon->device     = 0;
 	mon->addr_start = 0;
 	mon->addr_end   = 0;
 }

 static int c3_reg_analysis(char *input, char *output)
 {
 	unsigned long status, vio_reg0, vio_reg1, vio_reg2, vio_reg3;
 	int port, subport, count = 0;
 	unsigned long addr;
 	char rw = 'n';

 	if (sscanf(input, "%lx %lx %lx %lx %lx",
 			 &status, &vio_reg0, &vio_reg1,
 			 &vio_reg2, &vio_reg3) != 5) {
 		pr_emerg("%s parma input error, buf:%s\n", __func__, input);
 		return 0;
 	}

 	if (status & 0x1) { /* read */
 		addr = vio_reg2;
 		port = vio_reg3 & 0xff;
 		subport = (vio_reg3 >> 8) & 0x7f;
 		rw = 'r';

 		count += sprintf(output + count, "DMC READ:");
 		count += sprintf(output + count, "addr=%09lx port=%s sub=%s\n",
 				 addr, to_ports(port), to_sub_ports_name(port, subport, rw));
 	}

 	if (status & 0x2) { /* write */
 		addr = vio_reg0;
 		port = vio_reg1 & 0xff;
 		subport = (vio_reg1 >> 8) & 0x7f;
 		rw = 'w';
 		count += sprintf(output + count, "DMC WRITE:");
 		count += sprintf(output + count, "addr=%09lx port=%s sub=%s\n",
 				 addr, to_ports(port), to_sub_ports_name(port, subport, rw));
 	}
 	return count;
 }

 static int c3_dmc_reg_control(char *input, char control, char *output)
 {
 	int count = 0, i;
 	unsigned long val;

 	switch (control) {
 	case 'a':	/* analysis sec vio reg */
 		count = c3_reg_analysis(input, output);
 		break;
 	case 'c':	/* clear sec statue reg */
 		dmc_prot_rw(NULL, DMC_SEC_STATUS, 0x3, DMC_WRITE);
 		break;
 	case 'd':	/* dump sec vio reg */
 		count += sprintf(output + count, "DMC SEC INFO:\n");
 		val = dmc_prot_rw(NULL, DMC_SEC_STATUS, 0, DMC_READ);
 		count += sprintf(output + count, "DMC_SEC_STATUS:%lx\n", val);
 		for (i = 0; i < 4; i++) {
 			val = dmc_prot_rw(NULL, DMC_VIO_ADDR0 + (i << 2), 0, DMC_READ);
 			count += sprintf(output + count, "DMC_VIO_ADDR%d:%lx\n", i, val);
 		}
 		break;
 	default:
 		break;
 	}

 	return count;
 }

 struct dmc_mon_ops c3_dmc_mon_ops = {
 	.handle_irq  = c3_dmc_mon_irq,
 	.vio_to_port = c3_dmc_vio_to_port,
 	.set_monitor = c3_dmc_mon_set,
 	.disable     = c3_dmc_mon_disable,
 	.dump_reg    = c3_dmc_dump_reg,
 	.reg_control = c3_dmc_reg_control,
 };
	// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
	/*
	* Copyright (c) 2019 Amlogic, Inc. All rights reserved.
	*/

	#include <linux/cdev.h>
	#include <linux/types.h>
	#include <linux/fs.h>
	#include <linux/device.h>
	#include <linux/slab.h>
	#include <linux/delay.h>
	#include <linux/uaccess.h>
	#include <linux/sched.h>
	#include <linux/platform_device.h>
	#include <linux/of.h>
	#include <linux/of_fdt.h>
	#include <linux/irqreturn.h>
	#include <linux/module.h>
	#include <linux/mm.h>

	#include <linux/cpu.h>
	#include <linux/smp.h>
	#include <linux/kallsyms.h>
	#include <linux/of_irq.h>
	#include <linux/interrupt.h>
	#include <linux/sched/clock.h>
	#include <linux/amlogic/page_trace.h>
	#include "ddr_port.h"
	#include "dmc_monitor.h"

	#define DMC_PROT0_STA ((0x00d0 << 2))
	#define DMC_PROT0_EDA ((0x00d1 << 2))
	#define DMC_PROT0_CTRL ((0x00d2 << 2))
	#define DMC_PROT0_CTRL1 ((0x00d3 << 2))

	#define DMC_PROT1_STA ((0x00d4 << 2))
	#define DMC_PROT1_EDA ((0x00d5 << 2))
	#define DMC_PROT1_CTRL ((0x00d6 << 2))
	#define DMC_PROT1_CTRL1 ((0x00d7 << 2))

	#define DMC_PROT_VIO_0 ((0x00d8 << 2))
	#define DMC_PROT_VIO_1 ((0x00d9 << 2))

	#define DMC_PROT_VIO_2 ((0x00da << 2))
	#define DMC_PROT_VIO_3 ((0x00db << 2))

	#define DMC_PROT_IRQ_CTRL ((0x00dc << 2))
	#define DMC_IRQ_STS ((0x00cf << 2))

	#define DMC_SEC_STATUS ((0x00fa << 2))
	#define DMC_VIO_ADDR0 ((0x00fb << 2))
	#define DMC_VIO_ADDR1 ((0x00fc << 2))
	#define DMC_VIO_ADDR2 ((0x00fd << 2))
	#define DMC_VIO_ADDR3 ((0x00fe << 2))

	#define DMC_VIO_PROT0 BIT(20)
	#define DMC_VIO_PROT1 BIT(21)

	static size_t c3_dmc_dump_reg(char *buf)
	{
	size_t sz = 0, i;
	unsigned long val;
	void *io = dmc_mon->mon_comm[0].io_mem;

	for (i = 0; i < 2; i++) {
	val = dmc_prot_rw(io, DMC_PROT0_STA + (i * 16), 0, DMC_READ);
	sz += sprintf(buf + sz, "DMC_PROT%zu_STA:%lx\n", i, val);
	val = dmc_prot_rw(io, DMC_PROT0_EDA + (i * 16), 0, DMC_READ);
	sz += sprintf(buf + sz, "DMC_PROT%zu_EDA:%lx\n", i, val);
	val = dmc_prot_rw(io, DMC_PROT0_CTRL + (i * 16), 0, DMC_READ);
	sz += sprintf(buf + sz, "DMC_PROT%zu_CTRL:%lx\n", i, val);
	val = dmc_prot_rw(io, DMC_PROT0_CTRL1 + (i * 16), 0, DMC_READ);
	sz += sprintf(buf + sz, "DMC_PROT%zu_CTRL1:%lx\n", i, val);
	}
	for (i = 0; i < 4; i++) {
	val = dmc_prot_rw(io, DMC_PROT_VIO_0 + (i << 2), 0, DMC_READ);
	sz += sprintf(buf + sz, "DMC_PROT_VIO_%zu:%lx\n", i, val);
	}
	val = dmc_prot_rw(io, DMC_PROT_IRQ_CTRL, 0, DMC_READ);
	sz += sprintf(buf + sz, "DMC_PROT_IRQ_CTRL:%lx\n", val);
	val = dmc_prot_rw(io, DMC_IRQ_STS, 0, DMC_READ);
	sz += sprintf(buf + sz, "DMC_IRQ_STS:%lx\n", val);

	return sz;
	}

	static int check_violation(struct dmc_monitor mon, void data)
	{
	int ret = -1;
	unsigned long irqreg;
	struct page *page;
	struct page_trace *trace;
	struct dmc_mon_comm mon_comm = (struct dmc_mon_comm )data;

	irqreg = dmc_prot_rw(mon_comm->io_mem, DMC_IRQ_STS, 0, DMC_READ);
	if (irqreg & DMC_WRITE_VIOLATION) {
	mon_comm->time = sched_clock();
	mon_comm->status = dmc_prot_rw(mon_comm->io_mem, DMC_PROT_VIO_1, 0, DMC_READ);
	/* combine address */
	mon_comm->addr = dmc_prot_rw(mon_comm->io_mem, DMC_PROT_VIO_0, 0, DMC_READ);
	mon_comm->rw = 'w';
	page = phys_to_page(mon_comm->addr);
	trace = dmc_find_page_base(page);
	if (trace)
	mon_comm->trace = *trace;
	else
	mon_comm->trace.ip_data = IP_INVALID;
	mon_comm->page_flags = page->flags & PAGEFLAGS_MASK;
	ret = 0;
	} else if (irqreg & DMC_READ_VIOLATION) {
	mon_comm->time = sched_clock();
	mon_comm->status = dmc_prot_rw(mon_comm->io_mem, DMC_PROT_VIO_3, 0, DMC_READ);
	mon_comm->addr = dmc_prot_rw(mon_comm->io_mem, DMC_PROT_VIO_2, 0, DMC_READ);
	mon_comm->rw = 'r';
	page = phys_to_page(mon_comm->addr);
	trace = dmc_find_page_base(page);
	if (trace)
	mon_comm->trace = *trace;
	else
	mon_comm->trace.ip_data = IP_INVALID;
	mon_comm->page_flags = page->flags & PAGEFLAGS_MASK;
	ret = 0;
	}

	return ret;
	}

	static int c3_dmc_mon_irq(struct dmc_monitor mon, void data, char clear)
	{
	unsigned long irqreg;
	struct dmc_mon_comm mon_comm = (struct dmc_mon_comm )data;

	if (clear) {
	/* clear irq */
	irqreg = dmc_prot_rw(mon_comm->io_mem, DMC_PROT_IRQ_CTRL, 0, DMC_READ);
	if (dmc_mon->debug & DMC_DEBUG_SUSPEND)
	irqreg &= ~0x04;
	else
	irqreg \|= 0x04; /* en */
	dmc_prot_rw(mon_comm->io_mem, DMC_PROT_IRQ_CTRL, irqreg, DMC_WRITE);
	} else {
	return check_violation(mon, data);
	}

	return 0;
	}

	static void c3_dmc_vio_to_port(void data, unsigned long vio_bit)
	{
	int port = 0, subport = 0;
	struct dmc_mon_comm mon_comm = (struct dmc_mon_comm )data;

	*vio_bit = DMC_VIO_PROT1 \| DMC_VIO_PROT0;
	port = mon_comm->status & 0xff;
	subport = (mon_comm->status >> 8) & 0x7f;

	mon_comm->port.name = to_ports(port);
	if (!mon_comm->port.name)
	sprintf(mon_comm->port.id, "%d", port);

	mon_comm->sub.name = to_sub_ports_name(port, subport, mon_comm->rw);
	if (!mon_comm->sub.name)
	sprintf(mon_comm->sub.id, "%d", subport);
	}

	static int c3_dmc_mon_set(struct dmc_monitor *mon)
	{
	unsigned long start, end, val;
	unsigned int dev1, dev2;
	void *io = dmc_mon->mon_comm[0].io_mem;

	if (!dmc_mon->device)
	return 0;

	start = mon->addr_start >> PAGE_SHIFT;
	end = ALIGN_DOWN(mon->addr_end, PAGE_SIZE);
	end = end >> PAGE_SHIFT;
	dev1 = mon->device & 0xffffffff;
	dev2 = mon->device >> 32;

	dmc_prot_rw(io, DMC_PROT_IRQ_CTRL, 0x3, DMC_WRITE);

	if (dev1) {
	dmc_prot_rw(io, DMC_PROT0_STA, start, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT0_EDA, end, DMC_WRITE);
	} else {
	dmc_prot_rw(io, DMC_PROT0_STA, 0, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT0_EDA, 0, DMC_WRITE);
	}

	/* when set exclude, PROT1 can not be used */
	if (dev2 && (dmc_mon->debug & DMC_DEBUG_INCLUDE)) {
	dmc_prot_rw(io, DMC_PROT1_STA, start, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT1_EDA, end, DMC_WRITE);
	} else {
	dmc_prot_rw(io, DMC_PROT1_STA, 0UL, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT1_EDA, 0UL, DMC_WRITE);
	}

	val = 0xf;
	if (dmc_mon->debug & DMC_DEBUG_WRITE)
	val \|= (1 << 27);

	if (dmc_mon->debug & DMC_DEBUG_READ)
	val \|= (1 << 26);

	if (dmc_mon->debug & DMC_DEBUG_INCLUDE)
	val \|= (1 << 8);
	else
	val &= ~(1 << 8);

	if (dev1) {
	dmc_prot_rw(io, DMC_PROT0_CTRL, val, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT0_CTRL1, dev1, DMC_WRITE);
	} else {
	dmc_prot_rw(io, DMC_PROT0_CTRL, 0UL, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT0_CTRL1, 0UL, DMC_WRITE);
	}

	/* when set exclude, PROT1 can not be used */
	if (dev2 && (dmc_mon->debug & DMC_DEBUG_INCLUDE)) {
	dmc_prot_rw(io, DMC_PROT1_CTRL, val, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT1_CTRL1, dev2, DMC_WRITE);
	} else {
	dmc_prot_rw(io, DMC_PROT1_CTRL, 0UL, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT1_CTRL1, 0UL, DMC_WRITE);
	}

	if (dmc_mon->debug & DMC_DEBUG_SUSPEND)
	val = 0X3;
	else
	val = 0X7;
	dmc_prot_rw(io, DMC_PROT_IRQ_CTRL, val, DMC_WRITE);

	pr_emerg("range:%08lx - %08lx, device:%16llx\n",
	mon->addr_start, mon->addr_end, mon->device);
	return 0;
	}

	void c3_dmc_mon_disable(struct dmc_monitor *mon)
	{
	void *io = dmc_mon->mon_comm[0].io_mem;

	dmc_prot_rw(io, DMC_PROT0_STA, 0, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT0_EDA, 0, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT1_STA, 0, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT1_EDA, 0, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT0_CTRL, 0, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT0_CTRL1, 0, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT1_CTRL, 0, DMC_WRITE);
	dmc_prot_rw(io, DMC_PROT1_CTRL1, 0, DMC_WRITE);
	mon->device = 0;
	mon->addr_start = 0;
	mon->addr_end = 0;
	}

	static int c3_reg_analysis(char input, char output)
	{
	unsigned long status, vio_reg0, vio_reg1, vio_reg2, vio_reg3;
	int port, subport, count = 0;
	unsigned long addr;
	char rw = 'n';

	if (sscanf(input, "%lx %lx %lx %lx %lx",
	&status, &vio_reg0, &vio_reg1,
	&vio_reg2, &vio_reg3) != 5) {
	pr_emerg("%s parma input error, buf:%s\n", __func__, input);
	return 0;
	}

	if (status & 0x1) { /* read */
	addr = vio_reg2;
	port = vio_reg3 & 0xff;
	subport = (vio_reg3 >> 8) & 0x7f;
	rw = 'r';

	count += sprintf(output + count, "DMC READ:");
	count += sprintf(output + count, "addr=%09lx port=%s sub=%s\n",
	addr, to_ports(port), to_sub_ports_name(port, subport, rw));
	}

	if (status & 0x2) { /* write */
	addr = vio_reg0;
	port = vio_reg1 & 0xff;
	subport = (vio_reg1 >> 8) & 0x7f;
	rw = 'w';
	count += sprintf(output + count, "DMC WRITE:");
	count += sprintf(output + count, "addr=%09lx port=%s sub=%s\n",
	addr, to_ports(port), to_sub_ports_name(port, subport, rw));
	}
	return count;
	}

	static int c3_dmc_reg_control(char input, char control, char output)
	{
	int count = 0, i;
	unsigned long val;

	switch (control) {
	case 'a': /* analysis sec vio reg */
	count = c3_reg_analysis(input, output);
	break;
	case 'c': /* clear sec statue reg */
	dmc_prot_rw(NULL, DMC_SEC_STATUS, 0x3, DMC_WRITE);
	break;
	case 'd': /* dump sec vio reg */
	count += sprintf(output + count, "DMC SEC INFO:\n");
	val = dmc_prot_rw(NULL, DMC_SEC_STATUS, 0, DMC_READ);
	count += sprintf(output + count, "DMC_SEC_STATUS:%lx\n", val);
	for (i = 0; i < 4; i++) {
	val = dmc_prot_rw(NULL, DMC_VIO_ADDR0 + (i << 2), 0, DMC_READ);
	count += sprintf(output + count, "DMC_VIO_ADDR%d:%lx\n", i, val);
	}
	break;
	default:
	break;
	}

	return count;
	}

	struct dmc_mon_ops c3_dmc_mon_ops = {
	.handle_irq = c3_dmc_mon_irq,
	.vio_to_port = c3_dmc_vio_to_port,
	.set_monitor = c3_dmc_mon_set,
	.disable = c3_dmc_mon_disable,
	.dump_reg = c3_dmc_dump_reg,
	.reg_control = c3_dmc_reg_control,
	};