13fafe9c2SBenjamin Herrenschmidt /*
23fafe9c2SBenjamin Herrenschmidt  * PowerNV LPC bus handling.
33fafe9c2SBenjamin Herrenschmidt  *
43fafe9c2SBenjamin Herrenschmidt  * Copyright 2013 IBM Corp.
53fafe9c2SBenjamin Herrenschmidt  *
63fafe9c2SBenjamin Herrenschmidt  * This program is free software; you can redistribute it and/or
73fafe9c2SBenjamin Herrenschmidt  * modify it under the terms of the GNU General Public License
83fafe9c2SBenjamin Herrenschmidt  * as published by the Free Software Foundation; either version
93fafe9c2SBenjamin Herrenschmidt  * 2 of the License, or (at your option) any later version.
103fafe9c2SBenjamin Herrenschmidt  */
113fafe9c2SBenjamin Herrenschmidt 
123fafe9c2SBenjamin Herrenschmidt #include <linux/kernel.h>
133fafe9c2SBenjamin Herrenschmidt #include <linux/of.h>
143fafe9c2SBenjamin Herrenschmidt #include <linux/bug.h>
15fa2dbe2eSBenjamin Herrenschmidt #include <linux/debugfs.h>
16fa2dbe2eSBenjamin Herrenschmidt #include <linux/io.h>
17fa2dbe2eSBenjamin Herrenschmidt #include <linux/slab.h>
183fafe9c2SBenjamin Herrenschmidt 
193fafe9c2SBenjamin Herrenschmidt #include <asm/machdep.h>
203fafe9c2SBenjamin Herrenschmidt #include <asm/firmware.h>
213fafe9c2SBenjamin Herrenschmidt #include <asm/xics.h>
223fafe9c2SBenjamin Herrenschmidt #include <asm/opal.h>
2326a2056eSRob Herring #include <asm/prom.h>
247c0f6ba6SLinus Torvalds #include <linux/uaccess.h>
250c0a3e5aSBenjamin Herrenschmidt #include <asm/debug.h>
2638e9d36bSBenjamin Herrenschmidt #include <asm/isa-bridge.h>
273fafe9c2SBenjamin Herrenschmidt 
283fafe9c2SBenjamin Herrenschmidt static int opal_lpc_chip_id = -1;
293fafe9c2SBenjamin Herrenschmidt 
303fafe9c2SBenjamin Herrenschmidt static u8 opal_lpc_inb(unsigned long port)
313fafe9c2SBenjamin Herrenschmidt {
323fafe9c2SBenjamin Herrenschmidt 	int64_t rc;
33803c2d2fSBenjamin Herrenschmidt 	__be32 data;
343fafe9c2SBenjamin Herrenschmidt 
353fafe9c2SBenjamin Herrenschmidt 	if (opal_lpc_chip_id < 0 || port > 0xffff)
363fafe9c2SBenjamin Herrenschmidt 		return 0xff;
373fafe9c2SBenjamin Herrenschmidt 	rc = opal_lpc_read(opal_lpc_chip_id, OPAL_LPC_IO, port, &data, 1);
38803c2d2fSBenjamin Herrenschmidt 	return rc ? 0xff : be32_to_cpu(data);
393fafe9c2SBenjamin Herrenschmidt }
403fafe9c2SBenjamin Herrenschmidt 
413fafe9c2SBenjamin Herrenschmidt static __le16 __opal_lpc_inw(unsigned long port)
423fafe9c2SBenjamin Herrenschmidt {
433fafe9c2SBenjamin Herrenschmidt 	int64_t rc;
44803c2d2fSBenjamin Herrenschmidt 	__be32 data;
453fafe9c2SBenjamin Herrenschmidt 
463fafe9c2SBenjamin Herrenschmidt 	if (opal_lpc_chip_id < 0 || port > 0xfffe)
473fafe9c2SBenjamin Herrenschmidt 		return 0xffff;
483fafe9c2SBenjamin Herrenschmidt 	if (port & 1)
493fafe9c2SBenjamin Herrenschmidt 		return (__le16)opal_lpc_inb(port) << 8 | opal_lpc_inb(port + 1);
503fafe9c2SBenjamin Herrenschmidt 	rc = opal_lpc_read(opal_lpc_chip_id, OPAL_LPC_IO, port, &data, 2);
51803c2d2fSBenjamin Herrenschmidt 	return rc ? 0xffff : be32_to_cpu(data);
523fafe9c2SBenjamin Herrenschmidt }
533fafe9c2SBenjamin Herrenschmidt static u16 opal_lpc_inw(unsigned long port)
543fafe9c2SBenjamin Herrenschmidt {
553fafe9c2SBenjamin Herrenschmidt 	return le16_to_cpu(__opal_lpc_inw(port));
563fafe9c2SBenjamin Herrenschmidt }
573fafe9c2SBenjamin Herrenschmidt 
583fafe9c2SBenjamin Herrenschmidt static __le32 __opal_lpc_inl(unsigned long port)
593fafe9c2SBenjamin Herrenschmidt {
603fafe9c2SBenjamin Herrenschmidt 	int64_t rc;
61803c2d2fSBenjamin Herrenschmidt 	__be32 data;
623fafe9c2SBenjamin Herrenschmidt 
633fafe9c2SBenjamin Herrenschmidt 	if (opal_lpc_chip_id < 0 || port > 0xfffc)
643fafe9c2SBenjamin Herrenschmidt 		return 0xffffffff;
653fafe9c2SBenjamin Herrenschmidt 	if (port & 3)
663fafe9c2SBenjamin Herrenschmidt 		return (__le32)opal_lpc_inb(port    ) << 24 |
673fafe9c2SBenjamin Herrenschmidt 		       (__le32)opal_lpc_inb(port + 1) << 16 |
683fafe9c2SBenjamin Herrenschmidt 		       (__le32)opal_lpc_inb(port + 2) <<  8 |
693fafe9c2SBenjamin Herrenschmidt 			       opal_lpc_inb(port + 3);
703fafe9c2SBenjamin Herrenschmidt 	rc = opal_lpc_read(opal_lpc_chip_id, OPAL_LPC_IO, port, &data, 4);
71803c2d2fSBenjamin Herrenschmidt 	return rc ? 0xffffffff : be32_to_cpu(data);
723fafe9c2SBenjamin Herrenschmidt }
733fafe9c2SBenjamin Herrenschmidt 
743fafe9c2SBenjamin Herrenschmidt static u32 opal_lpc_inl(unsigned long port)
753fafe9c2SBenjamin Herrenschmidt {
763fafe9c2SBenjamin Herrenschmidt 	return le32_to_cpu(__opal_lpc_inl(port));
773fafe9c2SBenjamin Herrenschmidt }
783fafe9c2SBenjamin Herrenschmidt 
793fafe9c2SBenjamin Herrenschmidt static void opal_lpc_outb(u8 val, unsigned long port)
803fafe9c2SBenjamin Herrenschmidt {
813fafe9c2SBenjamin Herrenschmidt 	if (opal_lpc_chip_id < 0 || port > 0xffff)
823fafe9c2SBenjamin Herrenschmidt 		return;
833fafe9c2SBenjamin Herrenschmidt 	opal_lpc_write(opal_lpc_chip_id, OPAL_LPC_IO, port, val, 1);
843fafe9c2SBenjamin Herrenschmidt }
853fafe9c2SBenjamin Herrenschmidt 
863fafe9c2SBenjamin Herrenschmidt static void __opal_lpc_outw(__le16 val, unsigned long port)
873fafe9c2SBenjamin Herrenschmidt {
883fafe9c2SBenjamin Herrenschmidt 	if (opal_lpc_chip_id < 0 || port > 0xfffe)
893fafe9c2SBenjamin Herrenschmidt 		return;
903fafe9c2SBenjamin Herrenschmidt 	if (port & 1) {
913fafe9c2SBenjamin Herrenschmidt 		opal_lpc_outb(val >> 8, port);
923fafe9c2SBenjamin Herrenschmidt 		opal_lpc_outb(val     , port + 1);
933fafe9c2SBenjamin Herrenschmidt 		return;
943fafe9c2SBenjamin Herrenschmidt 	}
953fafe9c2SBenjamin Herrenschmidt 	opal_lpc_write(opal_lpc_chip_id, OPAL_LPC_IO, port, val, 2);
963fafe9c2SBenjamin Herrenschmidt }
973fafe9c2SBenjamin Herrenschmidt 
983fafe9c2SBenjamin Herrenschmidt static void opal_lpc_outw(u16 val, unsigned long port)
993fafe9c2SBenjamin Herrenschmidt {
1003fafe9c2SBenjamin Herrenschmidt 	__opal_lpc_outw(cpu_to_le16(val), port);
1013fafe9c2SBenjamin Herrenschmidt }
1023fafe9c2SBenjamin Herrenschmidt 
1033fafe9c2SBenjamin Herrenschmidt static void __opal_lpc_outl(__le32 val, unsigned long port)
1043fafe9c2SBenjamin Herrenschmidt {
1053fafe9c2SBenjamin Herrenschmidt 	if (opal_lpc_chip_id < 0 || port > 0xfffc)
1063fafe9c2SBenjamin Herrenschmidt 		return;
1073fafe9c2SBenjamin Herrenschmidt 	if (port & 3) {
1083fafe9c2SBenjamin Herrenschmidt 		opal_lpc_outb(val >> 24, port);
1093fafe9c2SBenjamin Herrenschmidt 		opal_lpc_outb(val >> 16, port + 1);
1103fafe9c2SBenjamin Herrenschmidt 		opal_lpc_outb(val >>  8, port + 2);
1113fafe9c2SBenjamin Herrenschmidt 		opal_lpc_outb(val      , port + 3);
1123fafe9c2SBenjamin Herrenschmidt 		return;
1133fafe9c2SBenjamin Herrenschmidt 	}
1143fafe9c2SBenjamin Herrenschmidt 	opal_lpc_write(opal_lpc_chip_id, OPAL_LPC_IO, port, val, 4);
1153fafe9c2SBenjamin Herrenschmidt }
1163fafe9c2SBenjamin Herrenschmidt 
1173fafe9c2SBenjamin Herrenschmidt static void opal_lpc_outl(u32 val, unsigned long port)
1183fafe9c2SBenjamin Herrenschmidt {
1193fafe9c2SBenjamin Herrenschmidt 	__opal_lpc_outl(cpu_to_le32(val), port);
1203fafe9c2SBenjamin Herrenschmidt }
1213fafe9c2SBenjamin Herrenschmidt 
1223fafe9c2SBenjamin Herrenschmidt static void opal_lpc_insb(unsigned long p, void *b, unsigned long c)
1233fafe9c2SBenjamin Herrenschmidt {
1243fafe9c2SBenjamin Herrenschmidt 	u8 *ptr = b;
1253fafe9c2SBenjamin Herrenschmidt 
1263fafe9c2SBenjamin Herrenschmidt 	while(c--)
1273fafe9c2SBenjamin Herrenschmidt 		*(ptr++) = opal_lpc_inb(p);
1283fafe9c2SBenjamin Herrenschmidt }
1293fafe9c2SBenjamin Herrenschmidt 
1303fafe9c2SBenjamin Herrenschmidt static void opal_lpc_insw(unsigned long p, void *b, unsigned long c)
1313fafe9c2SBenjamin Herrenschmidt {
1323fafe9c2SBenjamin Herrenschmidt 	__le16 *ptr = b;
1333fafe9c2SBenjamin Herrenschmidt 
1343fafe9c2SBenjamin Herrenschmidt 	while(c--)
1353fafe9c2SBenjamin Herrenschmidt 		*(ptr++) = __opal_lpc_inw(p);
1363fafe9c2SBenjamin Herrenschmidt }
1373fafe9c2SBenjamin Herrenschmidt 
1383fafe9c2SBenjamin Herrenschmidt static void opal_lpc_insl(unsigned long p, void *b, unsigned long c)
1393fafe9c2SBenjamin Herrenschmidt {
1403fafe9c2SBenjamin Herrenschmidt 	__le32 *ptr = b;
1413fafe9c2SBenjamin Herrenschmidt 
1423fafe9c2SBenjamin Herrenschmidt 	while(c--)
1433fafe9c2SBenjamin Herrenschmidt 		*(ptr++) = __opal_lpc_inl(p);
1443fafe9c2SBenjamin Herrenschmidt }
1453fafe9c2SBenjamin Herrenschmidt 
1463fafe9c2SBenjamin Herrenschmidt static void opal_lpc_outsb(unsigned long p, const void *b, unsigned long c)
1473fafe9c2SBenjamin Herrenschmidt {
1483fafe9c2SBenjamin Herrenschmidt 	const u8 *ptr = b;
1493fafe9c2SBenjamin Herrenschmidt 
1503fafe9c2SBenjamin Herrenschmidt 	while(c--)
1513fafe9c2SBenjamin Herrenschmidt 		opal_lpc_outb(*(ptr++), p);
1523fafe9c2SBenjamin Herrenschmidt }
1533fafe9c2SBenjamin Herrenschmidt 
1543fafe9c2SBenjamin Herrenschmidt static void opal_lpc_outsw(unsigned long p, const void *b, unsigned long c)
1553fafe9c2SBenjamin Herrenschmidt {
1563fafe9c2SBenjamin Herrenschmidt 	const __le16 *ptr = b;
1573fafe9c2SBenjamin Herrenschmidt 
1583fafe9c2SBenjamin Herrenschmidt 	while(c--)
1593fafe9c2SBenjamin Herrenschmidt 		__opal_lpc_outw(*(ptr++), p);
1603fafe9c2SBenjamin Herrenschmidt }
1613fafe9c2SBenjamin Herrenschmidt 
1623fafe9c2SBenjamin Herrenschmidt static void opal_lpc_outsl(unsigned long p, const void *b, unsigned long c)
1633fafe9c2SBenjamin Herrenschmidt {
1643fafe9c2SBenjamin Herrenschmidt 	const __le32 *ptr = b;
1653fafe9c2SBenjamin Herrenschmidt 
1663fafe9c2SBenjamin Herrenschmidt 	while(c--)
1673fafe9c2SBenjamin Herrenschmidt 		__opal_lpc_outl(*(ptr++), p);
1683fafe9c2SBenjamin Herrenschmidt }
1693fafe9c2SBenjamin Herrenschmidt 
1703fafe9c2SBenjamin Herrenschmidt static const struct ppc_pci_io opal_lpc_io = {
1713fafe9c2SBenjamin Herrenschmidt 	.inb	= opal_lpc_inb,
1723fafe9c2SBenjamin Herrenschmidt 	.inw	= opal_lpc_inw,
1733fafe9c2SBenjamin Herrenschmidt 	.inl	= opal_lpc_inl,
1743fafe9c2SBenjamin Herrenschmidt 	.outb	= opal_lpc_outb,
1753fafe9c2SBenjamin Herrenschmidt 	.outw	= opal_lpc_outw,
1763fafe9c2SBenjamin Herrenschmidt 	.outl	= opal_lpc_outl,
1773fafe9c2SBenjamin Herrenschmidt 	.insb	= opal_lpc_insb,
1783fafe9c2SBenjamin Herrenschmidt 	.insw	= opal_lpc_insw,
1793fafe9c2SBenjamin Herrenschmidt 	.insl	= opal_lpc_insl,
1803fafe9c2SBenjamin Herrenschmidt 	.outsb	= opal_lpc_outsb,
1813fafe9c2SBenjamin Herrenschmidt 	.outsw	= opal_lpc_outsw,
1823fafe9c2SBenjamin Herrenschmidt 	.outsl	= opal_lpc_outsl,
1833fafe9c2SBenjamin Herrenschmidt };
1843fafe9c2SBenjamin Herrenschmidt 
185fa2dbe2eSBenjamin Herrenschmidt #ifdef CONFIG_DEBUG_FS
186fa2dbe2eSBenjamin Herrenschmidt struct lpc_debugfs_entry {
187fa2dbe2eSBenjamin Herrenschmidt 	enum OpalLPCAddressType lpc_type;
188fa2dbe2eSBenjamin Herrenschmidt };
189fa2dbe2eSBenjamin Herrenschmidt 
190fa2dbe2eSBenjamin Herrenschmidt static ssize_t lpc_debug_read(struct file *filp, char __user *ubuf,
191fa2dbe2eSBenjamin Herrenschmidt 			      size_t count, loff_t *ppos)
192fa2dbe2eSBenjamin Herrenschmidt {
193fa2dbe2eSBenjamin Herrenschmidt 	struct lpc_debugfs_entry *lpc = filp->private_data;
194fa2dbe2eSBenjamin Herrenschmidt 	u32 data, pos, len, todo;
195fa2dbe2eSBenjamin Herrenschmidt 	int rc;
196fa2dbe2eSBenjamin Herrenschmidt 
197fa2dbe2eSBenjamin Herrenschmidt 	if (!access_ok(VERIFY_WRITE, ubuf, count))
198fa2dbe2eSBenjamin Herrenschmidt 		return -EFAULT;
199fa2dbe2eSBenjamin Herrenschmidt 
200fa2dbe2eSBenjamin Herrenschmidt 	todo = count;
201fa2dbe2eSBenjamin Herrenschmidt 	while (todo) {
202fa2dbe2eSBenjamin Herrenschmidt 		pos = *ppos;
203fa2dbe2eSBenjamin Herrenschmidt 
204fa2dbe2eSBenjamin Herrenschmidt 		/*
205fa2dbe2eSBenjamin Herrenschmidt 		 * Select access size based on count and alignment and
206fa2dbe2eSBenjamin Herrenschmidt 		 * access type. IO and MEM only support byte acceses,
207fa2dbe2eSBenjamin Herrenschmidt 		 * FW supports all 3.
208fa2dbe2eSBenjamin Herrenschmidt 		 */
209fa2dbe2eSBenjamin Herrenschmidt 		len = 1;
210fa2dbe2eSBenjamin Herrenschmidt 		if (lpc->lpc_type == OPAL_LPC_FW) {
211fa2dbe2eSBenjamin Herrenschmidt 			if (todo > 3 && (pos & 3) == 0)
212fa2dbe2eSBenjamin Herrenschmidt 				len = 4;
213fa2dbe2eSBenjamin Herrenschmidt 			else if (todo > 1 && (pos & 1) == 0)
214fa2dbe2eSBenjamin Herrenschmidt 				len = 2;
215fa2dbe2eSBenjamin Herrenschmidt 		}
216fa2dbe2eSBenjamin Herrenschmidt 		rc = opal_lpc_read(opal_lpc_chip_id, lpc->lpc_type, pos,
217bf19edd2SMichael Ellerman 				   &data, len);
218fa2dbe2eSBenjamin Herrenschmidt 		if (rc)
219fa2dbe2eSBenjamin Herrenschmidt 			return -ENXIO;
220325e4114SBenjamin Herrenschmidt 
221325e4114SBenjamin Herrenschmidt 		/*
222325e4114SBenjamin Herrenschmidt 		 * Now there is some trickery with the data returned by OPAL
223325e4114SBenjamin Herrenschmidt 		 * as it's the desired data right justified in a 32-bit BE
224325e4114SBenjamin Herrenschmidt 		 * word.
225325e4114SBenjamin Herrenschmidt 		 *
226325e4114SBenjamin Herrenschmidt 		 * This is a very bad interface and I'm to blame for it :-(
227325e4114SBenjamin Herrenschmidt 		 *
228325e4114SBenjamin Herrenschmidt 		 * So we can't just apply a 32-bit swap to what comes from OPAL,
229325e4114SBenjamin Herrenschmidt 		 * because user space expects the *bytes* to be in their proper
230325e4114SBenjamin Herrenschmidt 		 * respective positions (ie, LPC position).
231325e4114SBenjamin Herrenschmidt 		 *
232325e4114SBenjamin Herrenschmidt 		 * So what we really want to do here is to shift data right
233325e4114SBenjamin Herrenschmidt 		 * appropriately on a LE kernel.
234325e4114SBenjamin Herrenschmidt 		 *
235325e4114SBenjamin Herrenschmidt 		 * IE. If the LPC transaction has bytes B0, B1, B2 and B3 in that
236325e4114SBenjamin Herrenschmidt 		 * order, we have in memory written to by OPAL at the "data"
237325e4114SBenjamin Herrenschmidt 		 * pointer:
238325e4114SBenjamin Herrenschmidt 		 *
239325e4114SBenjamin Herrenschmidt 		 *               Bytes:      OPAL "data"   LE "data"
240325e4114SBenjamin Herrenschmidt 		 *   32-bit:   B0 B1 B2 B3   B0B1B2B3      B3B2B1B0
241325e4114SBenjamin Herrenschmidt 		 *   16-bit:   B0 B1         0000B0B1      B1B00000
242325e4114SBenjamin Herrenschmidt 		 *    8-bit:   B0            000000B0      B0000000
243325e4114SBenjamin Herrenschmidt 		 *
244325e4114SBenjamin Herrenschmidt 		 * So a BE kernel will have the leftmost of the above in the MSB
245325e4114SBenjamin Herrenschmidt 		 * and rightmost in the LSB and can just then "cast" the u32 "data"
246325e4114SBenjamin Herrenschmidt 		 * down to the appropriate quantity and write it.
247325e4114SBenjamin Herrenschmidt 		 *
248325e4114SBenjamin Herrenschmidt 		 * However, an LE kernel can't. It doesn't need to swap because a
249325e4114SBenjamin Herrenschmidt 		 * load from data followed by a store to user are going to preserve
250325e4114SBenjamin Herrenschmidt 		 * the byte ordering which is the wire byte order which is what the
251325e4114SBenjamin Herrenschmidt 		 * user wants, but in order to "crop" to the right size, we need to
252325e4114SBenjamin Herrenschmidt 		 * shift right first.
253325e4114SBenjamin Herrenschmidt 		 */
254fa2dbe2eSBenjamin Herrenschmidt 		switch(len) {
255fa2dbe2eSBenjamin Herrenschmidt 		case 4:
256fa2dbe2eSBenjamin Herrenschmidt 			rc = __put_user((u32)data, (u32 __user *)ubuf);
257fa2dbe2eSBenjamin Herrenschmidt 			break;
258fa2dbe2eSBenjamin Herrenschmidt 		case 2:
259325e4114SBenjamin Herrenschmidt #ifdef __LITTLE_ENDIAN__
260325e4114SBenjamin Herrenschmidt 			data >>= 16;
261325e4114SBenjamin Herrenschmidt #endif
262fa2dbe2eSBenjamin Herrenschmidt 			rc = __put_user((u16)data, (u16 __user *)ubuf);
263fa2dbe2eSBenjamin Herrenschmidt 			break;
264fa2dbe2eSBenjamin Herrenschmidt 		default:
265325e4114SBenjamin Herrenschmidt #ifdef __LITTLE_ENDIAN__
266325e4114SBenjamin Herrenschmidt 			data >>= 24;
267325e4114SBenjamin Herrenschmidt #endif
268fa2dbe2eSBenjamin Herrenschmidt 			rc = __put_user((u8)data, (u8 __user *)ubuf);
269fa2dbe2eSBenjamin Herrenschmidt 			break;
270fa2dbe2eSBenjamin Herrenschmidt 		}
271fa2dbe2eSBenjamin Herrenschmidt 		if (rc)
272fa2dbe2eSBenjamin Herrenschmidt 			return -EFAULT;
273fa2dbe2eSBenjamin Herrenschmidt 		*ppos += len;
274fa2dbe2eSBenjamin Herrenschmidt 		ubuf += len;
275fa2dbe2eSBenjamin Herrenschmidt 		todo -= len;
276fa2dbe2eSBenjamin Herrenschmidt 	}
277fa2dbe2eSBenjamin Herrenschmidt 
278fa2dbe2eSBenjamin Herrenschmidt 	return count;
279fa2dbe2eSBenjamin Herrenschmidt }
280fa2dbe2eSBenjamin Herrenschmidt 
281fa2dbe2eSBenjamin Herrenschmidt static ssize_t lpc_debug_write(struct file *filp, const char __user *ubuf,
282fa2dbe2eSBenjamin Herrenschmidt 			       size_t count, loff_t *ppos)
283fa2dbe2eSBenjamin Herrenschmidt {
284fa2dbe2eSBenjamin Herrenschmidt 	struct lpc_debugfs_entry *lpc = filp->private_data;
285fa2dbe2eSBenjamin Herrenschmidt 	u32 data, pos, len, todo;
286fa2dbe2eSBenjamin Herrenschmidt 	int rc;
287fa2dbe2eSBenjamin Herrenschmidt 
288fa2dbe2eSBenjamin Herrenschmidt 	if (!access_ok(VERIFY_READ, ubuf, count))
289fa2dbe2eSBenjamin Herrenschmidt 		return -EFAULT;
290fa2dbe2eSBenjamin Herrenschmidt 
291fa2dbe2eSBenjamin Herrenschmidt 	todo = count;
292fa2dbe2eSBenjamin Herrenschmidt 	while (todo) {
293fa2dbe2eSBenjamin Herrenschmidt 		pos = *ppos;
294fa2dbe2eSBenjamin Herrenschmidt 
295fa2dbe2eSBenjamin Herrenschmidt 		/*
296fa2dbe2eSBenjamin Herrenschmidt 		 * Select access size based on count and alignment and
297fa2dbe2eSBenjamin Herrenschmidt 		 * access type. IO and MEM only support byte acceses,
298fa2dbe2eSBenjamin Herrenschmidt 		 * FW supports all 3.
299fa2dbe2eSBenjamin Herrenschmidt 		 */
300fa2dbe2eSBenjamin Herrenschmidt 		len = 1;
301fa2dbe2eSBenjamin Herrenschmidt 		if (lpc->lpc_type == OPAL_LPC_FW) {
302fa2dbe2eSBenjamin Herrenschmidt 			if (todo > 3 && (pos & 3) == 0)
303fa2dbe2eSBenjamin Herrenschmidt 				len = 4;
304fa2dbe2eSBenjamin Herrenschmidt 			else if (todo > 1 && (pos & 1) == 0)
305fa2dbe2eSBenjamin Herrenschmidt 				len = 2;
306fa2dbe2eSBenjamin Herrenschmidt 		}
307325e4114SBenjamin Herrenschmidt 
308325e4114SBenjamin Herrenschmidt 		/*
309325e4114SBenjamin Herrenschmidt 		 * Similarly to the read case, we have some trickery here but
310325e4114SBenjamin Herrenschmidt 		 * it's different to handle. We need to pass the value to OPAL in
311325e4114SBenjamin Herrenschmidt 		 * a register whose layout depends on the access size. We want
312325e4114SBenjamin Herrenschmidt 		 * to reproduce the memory layout of the user, however we aren't
313325e4114SBenjamin Herrenschmidt 		 * doing a load from user and a store to another memory location
314325e4114SBenjamin Herrenschmidt 		 * which would achieve that. Here we pass the value to OPAL via
315325e4114SBenjamin Herrenschmidt 		 * a register which is expected to contain the "BE" interpretation
316325e4114SBenjamin Herrenschmidt 		 * of the byte sequence. IE: for a 32-bit access, byte 0 should be
317325e4114SBenjamin Herrenschmidt 		 * in the MSB. So here we *do* need to byteswap on LE.
318325e4114SBenjamin Herrenschmidt 		 *
319325e4114SBenjamin Herrenschmidt 		 *           User bytes:    LE "data"  OPAL "data"
320325e4114SBenjamin Herrenschmidt 		 *  32-bit:  B0 B1 B2 B3    B3B2B1B0   B0B1B2B3
321325e4114SBenjamin Herrenschmidt 		 *  16-bit:  B0 B1          0000B1B0   0000B0B1
322325e4114SBenjamin Herrenschmidt 		 *   8-bit:  B0             000000B0   000000B0
323325e4114SBenjamin Herrenschmidt 		 */
324fa2dbe2eSBenjamin Herrenschmidt 		switch(len) {
325fa2dbe2eSBenjamin Herrenschmidt 		case 4:
326fa2dbe2eSBenjamin Herrenschmidt 			rc = __get_user(data, (u32 __user *)ubuf);
327325e4114SBenjamin Herrenschmidt 			data = cpu_to_be32(data);
328fa2dbe2eSBenjamin Herrenschmidt 			break;
329fa2dbe2eSBenjamin Herrenschmidt 		case 2:
330fa2dbe2eSBenjamin Herrenschmidt 			rc = __get_user(data, (u16 __user *)ubuf);
331325e4114SBenjamin Herrenschmidt 			data = cpu_to_be16(data);
332fa2dbe2eSBenjamin Herrenschmidt 			break;
333fa2dbe2eSBenjamin Herrenschmidt 		default:
334fa2dbe2eSBenjamin Herrenschmidt 			rc = __get_user(data, (u8 __user *)ubuf);
335fa2dbe2eSBenjamin Herrenschmidt 			break;
336fa2dbe2eSBenjamin Herrenschmidt 		}
337fa2dbe2eSBenjamin Herrenschmidt 		if (rc)
338fa2dbe2eSBenjamin Herrenschmidt 			return -EFAULT;
339fa2dbe2eSBenjamin Herrenschmidt 
340fa2dbe2eSBenjamin Herrenschmidt 		rc = opal_lpc_write(opal_lpc_chip_id, lpc->lpc_type, pos,
341fa2dbe2eSBenjamin Herrenschmidt 				    data, len);
342fa2dbe2eSBenjamin Herrenschmidt 		if (rc)
343fa2dbe2eSBenjamin Herrenschmidt 			return -ENXIO;
344fa2dbe2eSBenjamin Herrenschmidt 		*ppos += len;
345fa2dbe2eSBenjamin Herrenschmidt 		ubuf += len;
346fa2dbe2eSBenjamin Herrenschmidt 		todo -= len;
347fa2dbe2eSBenjamin Herrenschmidt 	}
348fa2dbe2eSBenjamin Herrenschmidt 
349fa2dbe2eSBenjamin Herrenschmidt 	return count;
350fa2dbe2eSBenjamin Herrenschmidt }
351fa2dbe2eSBenjamin Herrenschmidt 
352fa2dbe2eSBenjamin Herrenschmidt static const struct file_operations lpc_fops = {
353fa2dbe2eSBenjamin Herrenschmidt 	.read =		lpc_debug_read,
354fa2dbe2eSBenjamin Herrenschmidt 	.write =	lpc_debug_write,
355fa2dbe2eSBenjamin Herrenschmidt 	.open =		simple_open,
356fa2dbe2eSBenjamin Herrenschmidt 	.llseek =	default_llseek,
357fa2dbe2eSBenjamin Herrenschmidt };
358fa2dbe2eSBenjamin Herrenschmidt 
359fa2dbe2eSBenjamin Herrenschmidt static int opal_lpc_debugfs_create_type(struct dentry *folder,
360fa2dbe2eSBenjamin Herrenschmidt 					const char *fname,
361fa2dbe2eSBenjamin Herrenschmidt 					enum OpalLPCAddressType type)
362fa2dbe2eSBenjamin Herrenschmidt {
363fa2dbe2eSBenjamin Herrenschmidt 	struct lpc_debugfs_entry *entry;
364fa2dbe2eSBenjamin Herrenschmidt 	entry = kzalloc(sizeof(*entry), GFP_KERNEL);
365fa2dbe2eSBenjamin Herrenschmidt 	if (!entry)
366fa2dbe2eSBenjamin Herrenschmidt 		return -ENOMEM;
367fa2dbe2eSBenjamin Herrenschmidt 	entry->lpc_type = type;
368fa2dbe2eSBenjamin Herrenschmidt 	debugfs_create_file(fname, 0600, folder, entry, &lpc_fops);
369fa2dbe2eSBenjamin Herrenschmidt 	return 0;
370fa2dbe2eSBenjamin Herrenschmidt }
371fa2dbe2eSBenjamin Herrenschmidt 
372fa2dbe2eSBenjamin Herrenschmidt static int opal_lpc_init_debugfs(void)
373fa2dbe2eSBenjamin Herrenschmidt {
374fa2dbe2eSBenjamin Herrenschmidt 	struct dentry *root;
375fa2dbe2eSBenjamin Herrenschmidt 	int rc = 0;
376fa2dbe2eSBenjamin Herrenschmidt 
377fa2dbe2eSBenjamin Herrenschmidt 	if (opal_lpc_chip_id < 0)
378fa2dbe2eSBenjamin Herrenschmidt 		return -ENODEV;
379fa2dbe2eSBenjamin Herrenschmidt 
380fa2dbe2eSBenjamin Herrenschmidt 	root = debugfs_create_dir("lpc", powerpc_debugfs_root);
381fa2dbe2eSBenjamin Herrenschmidt 
382fa2dbe2eSBenjamin Herrenschmidt 	rc |= opal_lpc_debugfs_create_type(root, "io", OPAL_LPC_IO);
383fa2dbe2eSBenjamin Herrenschmidt 	rc |= opal_lpc_debugfs_create_type(root, "mem", OPAL_LPC_MEM);
384fa2dbe2eSBenjamin Herrenschmidt 	rc |= opal_lpc_debugfs_create_type(root, "fw", OPAL_LPC_FW);
385fa2dbe2eSBenjamin Herrenschmidt 	return rc;
386fa2dbe2eSBenjamin Herrenschmidt }
387b14726c5SMichael Ellerman machine_device_initcall(powernv, opal_lpc_init_debugfs);
388fa2dbe2eSBenjamin Herrenschmidt #endif  /* CONFIG_DEBUG_FS */
389fa2dbe2eSBenjamin Herrenschmidt 
3903fafe9c2SBenjamin Herrenschmidt void opal_lpc_init(void)
3913fafe9c2SBenjamin Herrenschmidt {
3923fafe9c2SBenjamin Herrenschmidt 	struct device_node *np;
3933fafe9c2SBenjamin Herrenschmidt 
3943fafe9c2SBenjamin Herrenschmidt 	/*
3953fafe9c2SBenjamin Herrenschmidt 	 * Look for a Power8 LPC bus tagged as "primary",
3963fafe9c2SBenjamin Herrenschmidt 	 * we currently support only one though the OPAL APIs
3973fafe9c2SBenjamin Herrenschmidt 	 * support any number.
3983fafe9c2SBenjamin Herrenschmidt 	 */
3993fafe9c2SBenjamin Herrenschmidt 	for_each_compatible_node(np, NULL, "ibm,power8-lpc") {
4003fafe9c2SBenjamin Herrenschmidt 		if (!of_device_is_available(np))
4013fafe9c2SBenjamin Herrenschmidt 			continue;
4023fafe9c2SBenjamin Herrenschmidt 		if (!of_get_property(np, "primary", NULL))
4033fafe9c2SBenjamin Herrenschmidt 			continue;
4043fafe9c2SBenjamin Herrenschmidt 		opal_lpc_chip_id = of_get_ibm_chip_id(np);
4053fafe9c2SBenjamin Herrenschmidt 		break;
4063fafe9c2SBenjamin Herrenschmidt 	}
4073fafe9c2SBenjamin Herrenschmidt 	if (opal_lpc_chip_id < 0)
4083fafe9c2SBenjamin Herrenschmidt 		return;
4093fafe9c2SBenjamin Herrenschmidt 
410023b13a5SBenjamin Herrenschmidt 	/* Does it support direct mapping ? */
411023b13a5SBenjamin Herrenschmidt 	if (of_get_property(np, "ranges", NULL)) {
412023b13a5SBenjamin Herrenschmidt 		pr_info("OPAL: Found memory mapped LPC bus on chip %d\n",
413023b13a5SBenjamin Herrenschmidt 			opal_lpc_chip_id);
414023b13a5SBenjamin Herrenschmidt 		isa_bridge_init_non_pci(np);
415023b13a5SBenjamin Herrenschmidt 	} else {
416023b13a5SBenjamin Herrenschmidt 		pr_info("OPAL: Found non-mapped LPC bus on chip %d\n",
417023b13a5SBenjamin Herrenschmidt 			opal_lpc_chip_id);
418023b13a5SBenjamin Herrenschmidt 
4193fafe9c2SBenjamin Herrenschmidt 		/* Setup special IO ops */
4203fafe9c2SBenjamin Herrenschmidt 		ppc_pci_io = opal_lpc_io;
4213fafe9c2SBenjamin Herrenschmidt 		isa_io_special = true;
422023b13a5SBenjamin Herrenschmidt 	}
4233fafe9c2SBenjamin Herrenschmidt }
424