[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
e2fa61d4 FB	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	*/
	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
138	/**
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	{
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);
157
35f7b961	158	WARN(true, "%s seen by %s %s at address %x\n",
e2fa61d4 FB	159	omap3_l3_code_string(code),
	160	omap3_l3_initiator_string(initid),
	161	multi ? "Multiple Errors" : "",
	162	address);
	163
	164	return IRQ_HANDLED;
	165	}
	166
	167	static irqreturn_t omap3_l3_app_irq(int irq, void *_l3)
	168	{
	169	struct omap3_l3 *l3 = _l3;
e2fa61d4 FB	170	u64 status, clear;
	171	u64 error;
	172	u64 error_addr;
	173	u64 err_source = 0;
	174	void __iomem *base;
	175	int int_type;
e2fa61d4 FB	176	irqreturn_t ret = IRQ_NONE;
e2fa61d4 FB	177
35f7b961	178	int_type = irq == l3->app_irq ? L3_APPLICATION_ERROR : L3_DEBUG_ERROR;
e2fa61d4 FB	179	if (!int_type) {
	180	status = omap3_l3_readll(l3->rt, L3_SI_FLAG_STATUS_0);
	181	/*
	182	* if we have a timeout error, there's nothing we can
	183	* do besides rebooting the board. So let's BUG on any
	184	* of such errors and handle the others. timeout error
	185	* is severe and not expected to occur.
	186	*/
	187	BUG_ON(status & L3_STATUS_0_TIMEOUT_MASK);
	188	} else {
	189	status = omap3_l3_readll(l3->rt, L3_SI_FLAG_STATUS_1);
	190	/* No timeout error for debug sources */
	191	}
	192
e2fa61d4	193	/* identify the error source */
342fd144	194	err_source = __ffs(status);
bc16b377	195
342fd144	196	base = l3->rt + omap3_l3_bases[int_type][err_source];
e2fa61d4	197	error = omap3_l3_readll(base, L3_ERROR_LOG);
e2fa61d4 FB	198	if (error) {
	199	error_addr = omap3_l3_readll(base, L3_ERROR_LOG_ADDR);
	200
	201	ret \|= omap3_l3_block_irq(l3, error, error_addr);
	202	}
	203
	204	/* Clear the status register */
35f7b961	205	clear = (L3_AGENT_STATUS_CLEAR_IA << int_type) \|
35f7b961	206	L3_AGENT_STATUS_CLEAR_TA;
e2fa61d4 FB	207	omap3_l3_writell(base, L3_AGENT_STATUS, clear);
	208
	209	/* clear the error log register */
	210	omap3_l3_writell(base, L3_ERROR_LOG, error);
	211
	212	return ret;
	213	}
	214
	215	static int __init omap3_l3_probe(struct platform_device *pdev)
	216	{
	217	struct omap3_l3 *l3;
	218	struct resource *res;
	219	int ret;
e2fa61d4 FB	220
e2fa61d4 FB	221	l3 = kzalloc(sizeof(*l3), GFP_KERNEL);
7529b703	222	if (!l3)
7529b703	223	return -ENOMEM;
e2fa61d4 FB	224
	225	platform_set_drvdata(pdev, l3);
	226
	227	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	228	if (!res) {
	229	dev_err(&pdev->dev, "couldn't find resource\n");
	230	ret = -ENODEV;
7529b703	231	goto err0;
e2fa61d4 FB	232	}
e2fa61d4 FB	233	l3->rt = ioremap(res->start, resource_size(res));
35f7b961	234	if (!l3->rt) {
e2fa61d4 FB	235	dev_err(&pdev->dev, "ioremap failed\n");
e2fa61d4 FB	236	ret = -ENOMEM;
7529b703	237	goto err0;
e2fa61d4 FB	238	}
e2fa61d4 FB	239
18a81019 AK	240	l3->debug_irq = platform_get_irq(pdev, 0);
18a81019 AK	241	ret = request_irq(l3->debug_irq, omap3_l3_app_irq,
e2fa61d4 FB	242	IRQF_DISABLED \| IRQF_TRIGGER_RISING,
	243	"l3-debug-irq", l3);
	244	if (ret) {
	245	dev_err(&pdev->dev, "couldn't request debug irq\n");
7529b703	246	goto err1;
e2fa61d4	247	}
e2fa61d4	248
18a81019 AK	249	l3->app_irq = platform_get_irq(pdev, 1);
18a81019 AK	250	ret = request_irq(l3->app_irq, omap3_l3_app_irq,
e2fa61d4 FB	251	IRQF_DISABLED \| IRQF_TRIGGER_RISING,
e2fa61d4 FB	252	"l3-app-irq", l3);
e2fa61d4 FB	253	if (ret) {
e2fa61d4 FB	254	dev_err(&pdev->dev, "couldn't request app irq\n");
7529b703	255	goto err2;
e2fa61d4 FB	256	}
e2fa61d4 FB	257
7529b703	258	return 0;
e2fa61d4	259
e2fa61d4	260	err2:
7529b703	261	free_irq(l3->debug_irq, l3);
e2fa61d4	262	err1:
7529b703	263	iounmap(l3->rt);
e2fa61d4	264	err0:
7529b703	265	kfree(l3);
e2fa61d4 FB	266	return ret;
	267	}
	268
	269	static int __exit omap3_l3_remove(struct platform_device *pdev)
	270	{
	271	struct omap3_l3 *l3 = platform_get_drvdata(pdev);
	272
	273	free_irq(l3->app_irq, l3);
	274	free_irq(l3->debug_irq, l3);
	275	iounmap(l3->rt);
	276	kfree(l3);
	277
	278	return 0;
	279	}
	280
	281	static struct platform_driver omap3_l3_driver = {
	282	.remove = __exit_p(omap3_l3_remove),
	283	.driver = {
	284	.name = "omap_l3_smx",
	285	},
	286	};
	287
	288	static int __init omap3_l3_init(void)
	289	{
	290	return platform_driver_probe(&omap3_l3_driver, omap3_l3_probe);
	291	}
	292	postcore_initcall_sync(omap3_l3_init);
	293
	294	static void __exit omap3_l3_exit(void)
	295	{
	296	platform_driver_unregister(&omap3_l3_driver);
	297	}
	298	module_exit(omap3_l3_exit);