[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / arm / mach-omap2 / omap_l3_smx.c

/*
 * OMAP3XXX L3 Interconnect Driver
 *
 * Copyright (C) 2011 Texas Corporation
 *	Felipe Balbi <balbi@ti.com>
 *	Santosh Shilimkar <santosh.shilimkar@ti.com>
 *	Sricharan <r.sricharan@ti.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
 * USA
 */

#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/platform_device.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include "omap_l3_smx.h"

static inline u64 omap3_l3_readll(void __iomem *base, u16 reg)
{
	return __raw_readll(base + reg);
}

static inline void omap3_l3_writell(void __iomem *base, u16 reg, u64 value)
{
	__raw_writell(value, base + reg);
}

static inline enum omap3_l3_code omap3_l3_decode_error_code(u64 error)
{
	return (error & 0x0f000000) >> L3_ERROR_LOG_CODE;
}

static inline u32 omap3_l3_decode_addr(u64 error_addr)
{
	return error_addr & 0xffffffff;
}

static inline unsigned omap3_l3_decode_cmd(u64 error)
{
	return (error & 0x07) >> L3_ERROR_LOG_CMD;
}

static inline enum omap3_l3_initiator_id omap3_l3_decode_initid(u64 error)
{
	return (error & 0xff00) >> L3_ERROR_LOG_INITID;
}

static inline unsigned omap3_l3_decode_req_info(u64 error)
{
	return (error >> 32) & 0xffff;
}

static char *omap3_l3_code_string(u8 code)
{
	switch (code) {
	case OMAP_L3_CODE_NOERROR:
		return "No Error";
	case OMAP_L3_CODE_UNSUP_CMD:
		return "Unsupported Command";
	case OMAP_L3_CODE_ADDR_HOLE:
		return "Address Hole";
	case OMAP_L3_CODE_PROTECT_VIOLATION:
		return "Protection Violation";
	case OMAP_L3_CODE_IN_BAND_ERR:
		return "In-band Error";
	case OMAP_L3_CODE_REQ_TOUT_NOT_ACCEPT:
		return "Request Timeout Not Accepted";
	case OMAP_L3_CODE_REQ_TOUT_NO_RESP:
		return "Request Timeout, no response";
	default:
		return "UNKNOWN error";
	}
}

static char *omap3_l3_initiator_string(u8 initid)
{
	switch (initid) {
	case OMAP_L3_LCD:
		return "LCD";
	case OMAP_L3_SAD2D:
		return "SAD2D";
	case OMAP_L3_IA_MPU_SS_1:
	case OMAP_L3_IA_MPU_SS_2:
	case OMAP_L3_IA_MPU_SS_3:
	case OMAP_L3_IA_MPU_SS_4:
	case OMAP_L3_IA_MPU_SS_5:
		return "MPU";
	case OMAP_L3_IA_IVA_SS_1:
	case OMAP_L3_IA_IVA_SS_2:
	case OMAP_L3_IA_IVA_SS_3:
		return "IVA_SS";
	case OMAP_L3_IA_IVA_SS_DMA_1:
	case OMAP_L3_IA_IVA_SS_DMA_2:
	case OMAP_L3_IA_IVA_SS_DMA_3:
	case OMAP_L3_IA_IVA_SS_DMA_4:
	case OMAP_L3_IA_IVA_SS_DMA_5:
	case OMAP_L3_IA_IVA_SS_DMA_6:
		return "IVA_SS_DMA";
	case OMAP_L3_IA_SGX:
		return "SGX";
	case OMAP_L3_IA_CAM_1:
	case OMAP_L3_IA_CAM_2:
	case OMAP_L3_IA_CAM_3:
		return "CAM";
	case OMAP_L3_IA_DAP:
		return "DAP";
	case OMAP_L3_SDMA_WR_1:
	case OMAP_L3_SDMA_WR_2:
		return "SDMA_WR";
	case OMAP_L3_SDMA_RD_1:
	case OMAP_L3_SDMA_RD_2:
	case OMAP_L3_SDMA_RD_3:
	case OMAP_L3_SDMA_RD_4:
		return "SDMA_RD";
	case OMAP_L3_USBOTG:
		return "USB_OTG";
	case OMAP_L3_USBHOST:
		return "USB_HOST";
	default:
		return "UNKNOWN Initiator";
	}
}

/*
 * omap3_l3_block_irq - handles a register block's irq
 * @l3: struct omap3_l3 *
 * @base: register block base address
 * @error: L3_ERROR_LOG register of our block
 *
 * Called in hard-irq context. Caller should take care of locking
 *
 * OMAP36xx TRM gives, on page 2001, Figure 9-10, the Typical Error
 * Analysis Sequence, we are following that sequence here, please
 * refer to that Figure for more information on the subject.
 */
static irqreturn_t omap3_l3_block_irq(struct omap3_l3 *l3,
					u64 error, int error_addr)
{
	u8 code = omap3_l3_decode_error_code(error);
	u8 initid = omap3_l3_decode_initid(error);
	u8 multi = error & L3_ERROR_LOG_MULTI;
	u32 address = omap3_l3_decode_addr(error_addr);

	WARN(true, "%s seen by %s %s at address %x\n",
			omap3_l3_code_string(code),
			omap3_l3_initiator_string(initid),
			multi ? "Multiple Errors" : "", address);

	return IRQ_HANDLED;
}

static irqreturn_t omap3_l3_app_irq(int irq, void *_l3)
{
	struct omap3_l3 *l3 = _l3;
	u64 status, clear;
	u64 error;
	u64 error_addr;
	u64 err_source = 0;
	void __iomem *base;
	int int_type;
	irqreturn_t ret = IRQ_NONE;

	int_type = irq == l3->app_irq ? L3_APPLICATION_ERROR : L3_DEBUG_ERROR;
	if (!int_type) {
		status = omap3_l3_readll(l3->rt, L3_SI_FLAG_STATUS_0);
		/*
		 * if we have a timeout error, there's nothing we can
		 * do besides rebooting the board. So let's BUG on any
		 * of such errors and handle the others. timeout error
		 * is severe and not expected to occur.
		 */
		BUG_ON(status & L3_STATUS_0_TIMEOUT_MASK);
	} else {
		status = omap3_l3_readll(l3->rt, L3_SI_FLAG_STATUS_1);
		/* No timeout error for debug sources */
	}

	/* identify the error source */
	err_source = __ffs(status);

	base = l3->rt + omap3_l3_bases[int_type][err_source];
	error = omap3_l3_readll(base, L3_ERROR_LOG);
	if (error) {
		error_addr = omap3_l3_readll(base, L3_ERROR_LOG_ADDR);
		ret |= omap3_l3_block_irq(l3, error, error_addr);
	}

	/* Clear the status register */
	clear = (L3_AGENT_STATUS_CLEAR_IA << int_type) |
		L3_AGENT_STATUS_CLEAR_TA;
	omap3_l3_writell(base, L3_AGENT_STATUS, clear);

	/* clear the error log register */
	omap3_l3_writell(base, L3_ERROR_LOG, error);

	return ret;
}

static int __init omap3_l3_probe(struct platform_device *pdev)
{
	struct omap3_l3 *l3;
	struct resource *res;
	int ret;

	l3 = kzalloc(sizeof(*l3), GFP_KERNEL);
	if (!l3)
		return -ENOMEM;

	platform_set_drvdata(pdev, l3);

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!res) {
		dev_err(&pdev->dev, "couldn't find resource\n");
		ret = -ENODEV;
		goto err0;
	}
	l3->rt = ioremap(res->start, resource_size(res));
	if (!l3->rt) {
		dev_err(&pdev->dev, "ioremap failed\n");
		ret = -ENOMEM;
		goto err0;
	}

	l3->debug_irq = platform_get_irq(pdev, 0);
	ret = request_irq(l3->debug_irq, omap3_l3_app_irq,
		IRQF_DISABLED | IRQF_TRIGGER_RISING,
		"l3-debug-irq", l3);
	if (ret) {
		dev_err(&pdev->dev, "couldn't request debug irq\n");
		goto err1;
	}

	l3->app_irq = platform_get_irq(pdev, 1);
	ret = request_irq(l3->app_irq, omap3_l3_app_irq,
		IRQF_DISABLED | IRQF_TRIGGER_RISING,
		"l3-app-irq", l3);
	if (ret) {
		dev_err(&pdev->dev, "couldn't request app irq\n");
		goto err2;
	}

	return 0;

err2:
	free_irq(l3->debug_irq, l3);
err1:
	iounmap(l3->rt);
err0:
	kfree(l3);
	return ret;
}

static int __exit omap3_l3_remove(struct platform_device *pdev)
{
	struct omap3_l3         *l3 = platform_get_drvdata(pdev);

	free_irq(l3->app_irq, l3);
	free_irq(l3->debug_irq, l3);
	iounmap(l3->rt);
	kfree(l3);

	return 0;
}

static struct platform_driver omap3_l3_driver = {
	.remove         = __exit_p(omap3_l3_remove),
	.driver         = {
	.name   = "omap_l3_smx",
	},
};

static int __init omap3_l3_init(void)
{
	return platform_driver_probe(&omap3_l3_driver, omap3_l3_probe);
}
postcore_initcall_sync(omap3_l3_init);

static void __exit omap3_l3_exit(void)
{
	platform_driver_unregister(&omap3_l3_driver);
}
module_exit(omap3_l3_exit);
Commit	Line	Data
ed0e3520	1	/*
	2	* OMAP3XXX L3 Interconnect Driver
	3	*
	4	* Copyright (C) 2011 Texas Corporation
	5	* Felipe Balbi <balbi@ti.com>
	6	* Santosh Shilimkar <santosh.shilimkar@ti.com>
	7	* Sricharan <r.sricharan@ti.com>
	8	*
	9	* This program is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License as published by
	11	* the Free Software Foundation; either version 2 of the License, or
	12	* (at your option) any later version.
	13	*
	14	* This program is distributed in the hope that it will be useful,
	15	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	16	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	17	* GNU General Public License for more details.
	18	*
	19	* You should have received a copy of the GNU General Public License
	20	* along with this program; if not, write to the Free Software
	21	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
	22	* USA
	23	*/
e2fa61d4 FB	24
	25	#include <linux/kernel.h>
	26	#include <linux/slab.h>
	27	#include <linux/platform_device.h>
	28	#include <linux/interrupt.h>
	29	#include <linux/io.h>
	30	#include "omap_l3_smx.h"
	31
	32	static inline u64 omap3_l3_readll(void __iomem *base, u16 reg)
	33	{
	34	return __raw_readll(base + reg);
	35	}
	36
	37	static inline void omap3_l3_writell(void __iomem *base, u16 reg, u64 value)
	38	{
	39	__raw_writell(value, base + reg);
	40	}
	41
	42	static inline enum omap3_l3_code omap3_l3_decode_error_code(u64 error)
	43	{
	44	return (error & 0x0f000000) >> L3_ERROR_LOG_CODE;
	45	}
	46
	47	static inline u32 omap3_l3_decode_addr(u64 error_addr)
	48	{
	49	return error_addr & 0xffffffff;
	50	}
	51
	52	static inline unsigned omap3_l3_decode_cmd(u64 error)
	53	{
	54	return (error & 0x07) >> L3_ERROR_LOG_CMD;
	55	}
	56
	57	static inline enum omap3_l3_initiator_id omap3_l3_decode_initid(u64 error)
	58	{
	59	return (error & 0xff00) >> L3_ERROR_LOG_INITID;
	60	}
	61
	62	static inline unsigned omap3_l3_decode_req_info(u64 error)
	63	{
	64	return (error >> 32) & 0xffff;
	65	}
	66
	67	static char *omap3_l3_code_string(u8 code)
	68	{
	69	switch (code) {
	70	case OMAP_L3_CODE_NOERROR:
	71	return "No Error";
	72	case OMAP_L3_CODE_UNSUP_CMD:
	73	return "Unsupported Command";
	74	case OMAP_L3_CODE_ADDR_HOLE:
	75	return "Address Hole";
	76	case OMAP_L3_CODE_PROTECT_VIOLATION:
	77	return "Protection Violation";
	78	case OMAP_L3_CODE_IN_BAND_ERR:
	79	return "In-band Error";
	80	case OMAP_L3_CODE_REQ_TOUT_NOT_ACCEPT:
	81	return "Request Timeout Not Accepted";
	82	case OMAP_L3_CODE_REQ_TOUT_NO_RESP:
	83	return "Request Timeout, no response";
	84	default:
	85	return "UNKNOWN error";
	86	}
	87	}
88
89	static char *omap3_l3_initiator_string(u8 initid)
90	{
91	switch (initid) {
92	case OMAP_L3_LCD:
93	return "LCD";
94	case OMAP_L3_SAD2D:
95	return "SAD2D";
96	case OMAP_L3_IA_MPU_SS_1:
97	case OMAP_L3_IA_MPU_SS_2:
98	case OMAP_L3_IA_MPU_SS_3:
99	case OMAP_L3_IA_MPU_SS_4:
100	case OMAP_L3_IA_MPU_SS_5:
101	return "MPU";
102	case OMAP_L3_IA_IVA_SS_1:
103	case OMAP_L3_IA_IVA_SS_2:
104	case OMAP_L3_IA_IVA_SS_3:
105	return "IVA_SS";
106	case OMAP_L3_IA_IVA_SS_DMA_1:
107	case OMAP_L3_IA_IVA_SS_DMA_2:
108	case OMAP_L3_IA_IVA_SS_DMA_3:
109	case OMAP_L3_IA_IVA_SS_DMA_4:
110	case OMAP_L3_IA_IVA_SS_DMA_5:
111	case OMAP_L3_IA_IVA_SS_DMA_6:
112	return "IVA_SS_DMA";
113	case OMAP_L3_IA_SGX:
114	return "SGX";
115	case OMAP_L3_IA_CAM_1:
116	case OMAP_L3_IA_CAM_2:
117	case OMAP_L3_IA_CAM_3:
118	return "CAM";
119	case OMAP_L3_IA_DAP:
120	return "DAP";
121	case OMAP_L3_SDMA_WR_1:
122	case OMAP_L3_SDMA_WR_2:
123	return "SDMA_WR";
124	case OMAP_L3_SDMA_RD_1:
125	case OMAP_L3_SDMA_RD_2:
126	case OMAP_L3_SDMA_RD_3:
127	case OMAP_L3_SDMA_RD_4:
128	return "SDMA_RD";
129	case OMAP_L3_USBOTG:
130	return "USB_OTG";
131	case OMAP_L3_USBHOST:
132	return "USB_HOST";
133	default:
134	return "UNKNOWN Initiator";
135	}
136	}
137
ed0e3520	138	/*
e2fa61d4 FB	139	* omap3_l3_block_irq - handles a register block's irq
	140	* @l3: struct omap3_l3 *
	141	* @base: register block base address
	142	* @error: L3_ERROR_LOG register of our block
	143	*
	144	* Called in hard-irq context. Caller should take care of locking
	145	*
	146	* OMAP36xx TRM gives, on page 2001, Figure 9-10, the Typical Error
	147	* Analysis Sequence, we are following that sequence here, please
	148	* refer to that Figure for more information on the subject.
	149	*/
	150	static irqreturn_t omap3_l3_block_irq(struct omap3_l3 *l3,
	151	u64 error, int error_addr)
	152	{
ed0e3520	153	u8 code = omap3_l3_decode_error_code(error);
	154	u8 initid = omap3_l3_decode_initid(error);
	155	u8 multi = error & L3_ERROR_LOG_MULTI;
	156	u32 address = omap3_l3_decode_addr(error_addr);
e2fa61d4	157
35f7b961	158	WARN(true, "%s seen by %s %s at address %x\n",
ed0e3520	159	omap3_l3_code_string(code),
	160	omap3_l3_initiator_string(initid),
	161	multi ? "Multiple Errors" : "", address);
e2fa61d4 FB	162
	163	return IRQ_HANDLED;
	164	}
	165
	166	static irqreturn_t omap3_l3_app_irq(int irq, void *_l3)
	167	{
ed0e3520	168	struct omap3_l3 *l3 = _l3;
	169	u64 status, clear;
	170	u64 error;
	171	u64 error_addr;
	172	u64 err_source = 0;
	173	void __iomem *base;
	174	int int_type;
	175	irqreturn_t ret = IRQ_NONE;
e2fa61d4	176
35f7b961	177	int_type = irq == l3->app_irq ? L3_APPLICATION_ERROR : L3_DEBUG_ERROR;
e2fa61d4 FB	178	if (!int_type) {
	179	status = omap3_l3_readll(l3->rt, L3_SI_FLAG_STATUS_0);
	180	/*
	181	* if we have a timeout error, there's nothing we can
	182	* do besides rebooting the board. So let's BUG on any
	183	* of such errors and handle the others. timeout error
	184	* is severe and not expected to occur.
	185	*/
	186	BUG_ON(status & L3_STATUS_0_TIMEOUT_MASK);
	187	} else {
	188	status = omap3_l3_readll(l3->rt, L3_SI_FLAG_STATUS_1);
	189	/* No timeout error for debug sources */
	190	}
	191
e2fa61d4	192	/* identify the error source */
342fd144	193	err_source = __ffs(status);
bc16b377	194
342fd144	195	base = l3->rt + omap3_l3_bases[int_type][err_source];
e2fa61d4	196	error = omap3_l3_readll(base, L3_ERROR_LOG);
e2fa61d4 FB	197	if (error) {
e2fa61d4 FB	198	error_addr = omap3_l3_readll(base, L3_ERROR_LOG_ADDR);
e2fa61d4 FB	199	ret \|= omap3_l3_block_irq(l3, error, error_addr);
	200	}
	201
	202	/* Clear the status register */
35f7b961	203	clear = (L3_AGENT_STATUS_CLEAR_IA << int_type) \|
35f7b961	204	L3_AGENT_STATUS_CLEAR_TA;
e2fa61d4 FB	205	omap3_l3_writell(base, L3_AGENT_STATUS, clear);
	206
	207	/* clear the error log register */
	208	omap3_l3_writell(base, L3_ERROR_LOG, error);
	209
	210	return ret;
	211	}
	212
	213	static int __init omap3_l3_probe(struct platform_device *pdev)
	214	{
ed0e3520	215	struct omap3_l3 *l3;
	216	struct resource *res;
	217	int ret;
e2fa61d4 FB	218
e2fa61d4 FB	219	l3 = kzalloc(sizeof(*l3), GFP_KERNEL);
7529b703	220	if (!l3)
7529b703	221	return -ENOMEM;
e2fa61d4 FB	222
	223	platform_set_drvdata(pdev, l3);
	224
	225	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	226	if (!res) {
	227	dev_err(&pdev->dev, "couldn't find resource\n");
	228	ret = -ENODEV;
7529b703	229	goto err0;
e2fa61d4 FB	230	}
e2fa61d4 FB	231	l3->rt = ioremap(res->start, resource_size(res));
35f7b961	232	if (!l3->rt) {
e2fa61d4 FB	233	dev_err(&pdev->dev, "ioremap failed\n");
e2fa61d4 FB	234	ret = -ENOMEM;
7529b703	235	goto err0;
e2fa61d4 FB	236	}
e2fa61d4 FB	237
18a81019 AK	238	l3->debug_irq = platform_get_irq(pdev, 0);
18a81019 AK	239	ret = request_irq(l3->debug_irq, omap3_l3_app_irq,
e2fa61d4 FB	240	IRQF_DISABLED \| IRQF_TRIGGER_RISING,
	241	"l3-debug-irq", l3);
	242	if (ret) {
	243	dev_err(&pdev->dev, "couldn't request debug irq\n");
7529b703	244	goto err1;
e2fa61d4	245	}
e2fa61d4	246
18a81019 AK	247	l3->app_irq = platform_get_irq(pdev, 1);
18a81019 AK	248	ret = request_irq(l3->app_irq, omap3_l3_app_irq,
e2fa61d4 FB	249	IRQF_DISABLED \| IRQF_TRIGGER_RISING,
e2fa61d4 FB	250	"l3-app-irq", l3);
e2fa61d4 FB	251	if (ret) {
e2fa61d4 FB	252	dev_err(&pdev->dev, "couldn't request app irq\n");
7529b703	253	goto err2;
e2fa61d4 FB	254	}
e2fa61d4 FB	255
7529b703	256	return 0;
e2fa61d4	257
e2fa61d4	258	err2:
7529b703	259	free_irq(l3->debug_irq, l3);
e2fa61d4	260	err1:
7529b703	261	iounmap(l3->rt);
e2fa61d4	262	err0:
7529b703	263	kfree(l3);
e2fa61d4 FB	264	return ret;
	265	}
	266
	267	static int __exit omap3_l3_remove(struct platform_device *pdev)
	268	{
	269	struct omap3_l3 *l3 = platform_get_drvdata(pdev);
	270
	271	free_irq(l3->app_irq, l3);
	272	free_irq(l3->debug_irq, l3);
	273	iounmap(l3->rt);
	274	kfree(l3);
	275
	276	return 0;
	277	}
	278
	279	static struct platform_driver omap3_l3_driver = {
	280	.remove = __exit_p(omap3_l3_remove),
	281	.driver = {
	282	.name = "omap_l3_smx",
	283	},
	284	};
	285
	286	static int __init omap3_l3_init(void)
	287	{
	288	return platform_driver_probe(&omap3_l3_driver, omap3_l3_probe);
	289	}
	290	postcore_initcall_sync(omap3_l3_init);
	291
	292	static void __exit omap3_l3_exit(void)
	293	{
	294	platform_driver_unregister(&omap3_l3_driver);
	295	}
	296	module_exit(omap3_l3_exit);