114a43e69SBenjamin Herrenschmidt /*
214a43e69SBenjamin Herrenschmidt  * PowerNV OPAL high level interfaces
314a43e69SBenjamin Herrenschmidt  *
414a43e69SBenjamin Herrenschmidt  * Copyright 2011 IBM Corp.
514a43e69SBenjamin Herrenschmidt  *
614a43e69SBenjamin Herrenschmidt  * This program is free software; you can redistribute it and/or
714a43e69SBenjamin Herrenschmidt  * modify it under the terms of the GNU General Public License
814a43e69SBenjamin Herrenschmidt  * as published by the Free Software Foundation; either version
914a43e69SBenjamin Herrenschmidt  * 2 of the License, or (at your option) any later version.
1014a43e69SBenjamin Herrenschmidt  */
1114a43e69SBenjamin Herrenschmidt 
1214a43e69SBenjamin Herrenschmidt #undef DEBUG
1314a43e69SBenjamin Herrenschmidt 
1414a43e69SBenjamin Herrenschmidt #include <linux/types.h>
1514a43e69SBenjamin Herrenschmidt #include <linux/of.h>
1614a43e69SBenjamin Herrenschmidt #include <linux/of_platform.h>
17a125e092SBenjamin Herrenschmidt #include <linux/interrupt.h>
1873ed148aSBenjamin Herrenschmidt #include <linux/slab.h>
1914a43e69SBenjamin Herrenschmidt #include <asm/opal.h>
2014a43e69SBenjamin Herrenschmidt #include <asm/firmware.h>
2114a43e69SBenjamin Herrenschmidt 
2214a43e69SBenjamin Herrenschmidt #include "powernv.h"
2314a43e69SBenjamin Herrenschmidt 
2414a43e69SBenjamin Herrenschmidt struct opal {
2514a43e69SBenjamin Herrenschmidt 	u64 base;
2614a43e69SBenjamin Herrenschmidt 	u64 entry;
2714a43e69SBenjamin Herrenschmidt } opal;
2814a43e69SBenjamin Herrenschmidt 
2914a43e69SBenjamin Herrenschmidt static struct device_node *opal_node;
3014a43e69SBenjamin Herrenschmidt static DEFINE_SPINLOCK(opal_write_lock);
31ed79ba9eSBenjamin Herrenschmidt extern u64 opal_mc_secondary_handler[];
3273ed148aSBenjamin Herrenschmidt static unsigned int *opal_irqs;
3373ed148aSBenjamin Herrenschmidt static unsigned int opal_irq_count;
3414a43e69SBenjamin Herrenschmidt 
3514a43e69SBenjamin Herrenschmidt int __init early_init_dt_scan_opal(unsigned long node,
3614a43e69SBenjamin Herrenschmidt 				   const char *uname, int depth, void *data)
3714a43e69SBenjamin Herrenschmidt {
3814a43e69SBenjamin Herrenschmidt 	const void *basep, *entryp;
3914a43e69SBenjamin Herrenschmidt 	unsigned long basesz, entrysz;
4014a43e69SBenjamin Herrenschmidt 
4114a43e69SBenjamin Herrenschmidt 	if (depth != 1 || strcmp(uname, "ibm,opal") != 0)
4214a43e69SBenjamin Herrenschmidt 		return 0;
4314a43e69SBenjamin Herrenschmidt 
4414a43e69SBenjamin Herrenschmidt 	basep  = of_get_flat_dt_prop(node, "opal-base-address", &basesz);
4514a43e69SBenjamin Herrenschmidt 	entryp = of_get_flat_dt_prop(node, "opal-entry-address", &entrysz);
4614a43e69SBenjamin Herrenschmidt 
4714a43e69SBenjamin Herrenschmidt 	if (!basep || !entryp)
4814a43e69SBenjamin Herrenschmidt 		return 1;
4914a43e69SBenjamin Herrenschmidt 
5014a43e69SBenjamin Herrenschmidt 	opal.base = of_read_number(basep, basesz/4);
5114a43e69SBenjamin Herrenschmidt 	opal.entry = of_read_number(entryp, entrysz/4);
5214a43e69SBenjamin Herrenschmidt 
5314a43e69SBenjamin Herrenschmidt 	pr_debug("OPAL Base  = 0x%llx (basep=%p basesz=%ld)\n",
5414a43e69SBenjamin Herrenschmidt 		 opal.base, basep, basesz);
5514a43e69SBenjamin Herrenschmidt 	pr_debug("OPAL Entry = 0x%llx (entryp=%p basesz=%ld)\n",
5614a43e69SBenjamin Herrenschmidt 		 opal.entry, entryp, entrysz);
5714a43e69SBenjamin Herrenschmidt 
5814a43e69SBenjamin Herrenschmidt 	powerpc_firmware_features |= FW_FEATURE_OPAL;
5914a43e69SBenjamin Herrenschmidt 	if (of_flat_dt_is_compatible(node, "ibm,opal-v2")) {
6014a43e69SBenjamin Herrenschmidt 		powerpc_firmware_features |= FW_FEATURE_OPALv2;
6114a43e69SBenjamin Herrenschmidt 		printk("OPAL V2 detected !\n");
6214a43e69SBenjamin Herrenschmidt 	} else {
6314a43e69SBenjamin Herrenschmidt 		printk("OPAL V1 detected !\n");
6414a43e69SBenjamin Herrenschmidt 	}
6514a43e69SBenjamin Herrenschmidt 
66c4463b37SJeremy Kerr 	return 1;
67c4463b37SJeremy Kerr }
68c4463b37SJeremy Kerr 
69c4463b37SJeremy Kerr static int __init opal_register_exception_handlers(void)
70c4463b37SJeremy Kerr {
71c4463b37SJeremy Kerr 	u64 glue;
72c4463b37SJeremy Kerr 
73c4463b37SJeremy Kerr 	if (!(powerpc_firmware_features & FW_FEATURE_OPAL))
74c4463b37SJeremy Kerr 		return -ENODEV;
75c4463b37SJeremy Kerr 
76ed79ba9eSBenjamin Herrenschmidt 	/* Hookup some exception handlers. We use the fwnmi area at 0x7000
77ed79ba9eSBenjamin Herrenschmidt 	 * to provide the glue space to OPAL
78ed79ba9eSBenjamin Herrenschmidt 	 */
79ed79ba9eSBenjamin Herrenschmidt 	glue = 0x7000;
80ed79ba9eSBenjamin Herrenschmidt 	opal_register_exception_handler(OPAL_MACHINE_CHECK_HANDLER,
81ed79ba9eSBenjamin Herrenschmidt 					__pa(opal_mc_secondary_handler[0]),
82ed79ba9eSBenjamin Herrenschmidt 					glue);
83ed79ba9eSBenjamin Herrenschmidt 	glue += 128;
84ed79ba9eSBenjamin Herrenschmidt 	opal_register_exception_handler(OPAL_HYPERVISOR_MAINTENANCE_HANDLER,
85ed79ba9eSBenjamin Herrenschmidt 					0, glue);
86ed79ba9eSBenjamin Herrenschmidt 	glue += 128;
87ed79ba9eSBenjamin Herrenschmidt 	opal_register_exception_handler(OPAL_SOFTPATCH_HANDLER, 0, glue);
88ed79ba9eSBenjamin Herrenschmidt 
89c4463b37SJeremy Kerr 	return 0;
9014a43e69SBenjamin Herrenschmidt }
9114a43e69SBenjamin Herrenschmidt 
92c4463b37SJeremy Kerr early_initcall(opal_register_exception_handlers);
93c4463b37SJeremy Kerr 
9414a43e69SBenjamin Herrenschmidt int opal_get_chars(uint32_t vtermno, char *buf, int count)
9514a43e69SBenjamin Herrenschmidt {
9614a43e69SBenjamin Herrenschmidt 	s64 len, rc;
9714a43e69SBenjamin Herrenschmidt 	u64 evt;
9814a43e69SBenjamin Herrenschmidt 
9914a43e69SBenjamin Herrenschmidt 	if (!opal.entry)
100daea1175SBenjamin Herrenschmidt 		return -ENODEV;
10114a43e69SBenjamin Herrenschmidt 	opal_poll_events(&evt);
10214a43e69SBenjamin Herrenschmidt 	if ((evt & OPAL_EVENT_CONSOLE_INPUT) == 0)
10314a43e69SBenjamin Herrenschmidt 		return 0;
10414a43e69SBenjamin Herrenschmidt 	len = count;
10514a43e69SBenjamin Herrenschmidt 	rc = opal_console_read(vtermno, &len, buf);
10614a43e69SBenjamin Herrenschmidt 	if (rc == OPAL_SUCCESS)
10714a43e69SBenjamin Herrenschmidt 		return len;
10814a43e69SBenjamin Herrenschmidt 	return 0;
10914a43e69SBenjamin Herrenschmidt }
11014a43e69SBenjamin Herrenschmidt 
11114a43e69SBenjamin Herrenschmidt int opal_put_chars(uint32_t vtermno, const char *data, int total_len)
11214a43e69SBenjamin Herrenschmidt {
11314a43e69SBenjamin Herrenschmidt 	int written = 0;
114daea1175SBenjamin Herrenschmidt 	s64 len, rc;
11514a43e69SBenjamin Herrenschmidt 	unsigned long flags;
11614a43e69SBenjamin Herrenschmidt 	u64 evt;
11714a43e69SBenjamin Herrenschmidt 
11814a43e69SBenjamin Herrenschmidt 	if (!opal.entry)
119daea1175SBenjamin Herrenschmidt 		return -ENODEV;
12014a43e69SBenjamin Herrenschmidt 
12114a43e69SBenjamin Herrenschmidt 	/* We want put_chars to be atomic to avoid mangling of hvsi
12214a43e69SBenjamin Herrenschmidt 	 * packets. To do that, we first test for room and return
123daea1175SBenjamin Herrenschmidt 	 * -EAGAIN if there isn't enough.
124daea1175SBenjamin Herrenschmidt 	 *
125daea1175SBenjamin Herrenschmidt 	 * Unfortunately, opal_console_write_buffer_space() doesn't
126daea1175SBenjamin Herrenschmidt 	 * appear to work on opal v1, so we just assume there is
127daea1175SBenjamin Herrenschmidt 	 * enough room and be done with it
12814a43e69SBenjamin Herrenschmidt 	 */
12914a43e69SBenjamin Herrenschmidt 	spin_lock_irqsave(&opal_write_lock, flags);
130daea1175SBenjamin Herrenschmidt 	if (firmware_has_feature(FW_FEATURE_OPALv2)) {
13114a43e69SBenjamin Herrenschmidt 		rc = opal_console_write_buffer_space(vtermno, &len);
13214a43e69SBenjamin Herrenschmidt 		if (rc || len < total_len) {
13314a43e69SBenjamin Herrenschmidt 			spin_unlock_irqrestore(&opal_write_lock, flags);
13414a43e69SBenjamin Herrenschmidt 			/* Closed -> drop characters */
13514a43e69SBenjamin Herrenschmidt 			if (rc)
13614a43e69SBenjamin Herrenschmidt 				return total_len;
13714a43e69SBenjamin Herrenschmidt 			opal_poll_events(&evt);
13814a43e69SBenjamin Herrenschmidt 			return -EAGAIN;
13914a43e69SBenjamin Herrenschmidt 		}
140daea1175SBenjamin Herrenschmidt 	}
14114a43e69SBenjamin Herrenschmidt 
14214a43e69SBenjamin Herrenschmidt 	/* We still try to handle partial completions, though they
14314a43e69SBenjamin Herrenschmidt 	 * should no longer happen.
14414a43e69SBenjamin Herrenschmidt 	 */
145daea1175SBenjamin Herrenschmidt 	rc = OPAL_BUSY;
14614a43e69SBenjamin Herrenschmidt 	while(total_len > 0 && (rc == OPAL_BUSY ||
14714a43e69SBenjamin Herrenschmidt 				rc == OPAL_BUSY_EVENT || rc == OPAL_SUCCESS)) {
14814a43e69SBenjamin Herrenschmidt 		len = total_len;
14914a43e69SBenjamin Herrenschmidt 		rc = opal_console_write(vtermno, &len, data);
1501de1455fSBenjamin Herrenschmidt 
1511de1455fSBenjamin Herrenschmidt 		/* Closed or other error drop */
1521de1455fSBenjamin Herrenschmidt 		if (rc != OPAL_SUCCESS && rc != OPAL_BUSY &&
1531de1455fSBenjamin Herrenschmidt 		    rc != OPAL_BUSY_EVENT) {
1541de1455fSBenjamin Herrenschmidt 			written = total_len;
1551de1455fSBenjamin Herrenschmidt 			break;
1561de1455fSBenjamin Herrenschmidt 		}
15714a43e69SBenjamin Herrenschmidt 		if (rc == OPAL_SUCCESS) {
15814a43e69SBenjamin Herrenschmidt 			total_len -= len;
15914a43e69SBenjamin Herrenschmidt 			data += len;
16014a43e69SBenjamin Herrenschmidt 			written += len;
16114a43e69SBenjamin Herrenschmidt 		}
16214a43e69SBenjamin Herrenschmidt 		/* This is a bit nasty but we need that for the console to
16314a43e69SBenjamin Herrenschmidt 		 * flush when there aren't any interrupts. We will clean
16414a43e69SBenjamin Herrenschmidt 		 * things a bit later to limit that to synchronous path
16514a43e69SBenjamin Herrenschmidt 		 * such as the kernel console and xmon/udbg
16614a43e69SBenjamin Herrenschmidt 		 */
16714a43e69SBenjamin Herrenschmidt 		do
16814a43e69SBenjamin Herrenschmidt 			opal_poll_events(&evt);
16914a43e69SBenjamin Herrenschmidt 		while(rc == OPAL_SUCCESS && (evt & OPAL_EVENT_CONSOLE_OUTPUT));
17014a43e69SBenjamin Herrenschmidt 	}
17114a43e69SBenjamin Herrenschmidt 	spin_unlock_irqrestore(&opal_write_lock, flags);
17214a43e69SBenjamin Herrenschmidt 	return written;
17314a43e69SBenjamin Herrenschmidt }
17414a43e69SBenjamin Herrenschmidt 
175ed79ba9eSBenjamin Herrenschmidt int opal_machine_check(struct pt_regs *regs)
176ed79ba9eSBenjamin Herrenschmidt {
177ed79ba9eSBenjamin Herrenschmidt 	struct opal_machine_check_event *opal_evt = get_paca()->opal_mc_evt;
178ed79ba9eSBenjamin Herrenschmidt 	struct opal_machine_check_event evt;
179ed79ba9eSBenjamin Herrenschmidt 	const char *level, *sevstr, *subtype;
180ed79ba9eSBenjamin Herrenschmidt 	static const char *opal_mc_ue_types[] = {
181ed79ba9eSBenjamin Herrenschmidt 		"Indeterminate",
182ed79ba9eSBenjamin Herrenschmidt 		"Instruction fetch",
183ed79ba9eSBenjamin Herrenschmidt 		"Page table walk ifetch",
184ed79ba9eSBenjamin Herrenschmidt 		"Load/Store",
185ed79ba9eSBenjamin Herrenschmidt 		"Page table walk Load/Store",
186ed79ba9eSBenjamin Herrenschmidt 	};
187ed79ba9eSBenjamin Herrenschmidt 	static const char *opal_mc_slb_types[] = {
188ed79ba9eSBenjamin Herrenschmidt 		"Indeterminate",
189ed79ba9eSBenjamin Herrenschmidt 		"Parity",
190ed79ba9eSBenjamin Herrenschmidt 		"Multihit",
191ed79ba9eSBenjamin Herrenschmidt 	};
192ed79ba9eSBenjamin Herrenschmidt 	static const char *opal_mc_erat_types[] = {
193ed79ba9eSBenjamin Herrenschmidt 		"Indeterminate",
194ed79ba9eSBenjamin Herrenschmidt 		"Parity",
195ed79ba9eSBenjamin Herrenschmidt 		"Multihit",
196ed79ba9eSBenjamin Herrenschmidt 	};
197ed79ba9eSBenjamin Herrenschmidt 	static const char *opal_mc_tlb_types[] = {
198ed79ba9eSBenjamin Herrenschmidt 		"Indeterminate",
199ed79ba9eSBenjamin Herrenschmidt 		"Parity",
200ed79ba9eSBenjamin Herrenschmidt 		"Multihit",
201ed79ba9eSBenjamin Herrenschmidt 	};
202ed79ba9eSBenjamin Herrenschmidt 
203ed79ba9eSBenjamin Herrenschmidt 	/* Copy the event structure and release the original */
204ed79ba9eSBenjamin Herrenschmidt 	evt = *opal_evt;
205ed79ba9eSBenjamin Herrenschmidt 	opal_evt->in_use = 0;
206ed79ba9eSBenjamin Herrenschmidt 
207ed79ba9eSBenjamin Herrenschmidt 	/* Print things out */
208ed79ba9eSBenjamin Herrenschmidt 	if (evt.version != OpalMCE_V1) {
209ed79ba9eSBenjamin Herrenschmidt 		pr_err("Machine Check Exception, Unknown event version %d !\n",
210ed79ba9eSBenjamin Herrenschmidt 		       evt.version);
211ed79ba9eSBenjamin Herrenschmidt 		return 0;
212ed79ba9eSBenjamin Herrenschmidt 	}
213ed79ba9eSBenjamin Herrenschmidt 	switch(evt.severity) {
214ed79ba9eSBenjamin Herrenschmidt 	case OpalMCE_SEV_NO_ERROR:
215ed79ba9eSBenjamin Herrenschmidt 		level = KERN_INFO;
216ed79ba9eSBenjamin Herrenschmidt 		sevstr = "Harmless";
217ed79ba9eSBenjamin Herrenschmidt 		break;
218ed79ba9eSBenjamin Herrenschmidt 	case OpalMCE_SEV_WARNING:
219ed79ba9eSBenjamin Herrenschmidt 		level = KERN_WARNING;
220ed79ba9eSBenjamin Herrenschmidt 		sevstr = "";
221ed79ba9eSBenjamin Herrenschmidt 		break;
222ed79ba9eSBenjamin Herrenschmidt 	case OpalMCE_SEV_ERROR_SYNC:
223ed79ba9eSBenjamin Herrenschmidt 		level = KERN_ERR;
224ed79ba9eSBenjamin Herrenschmidt 		sevstr = "Severe";
225ed79ba9eSBenjamin Herrenschmidt 		break;
226ed79ba9eSBenjamin Herrenschmidt 	case OpalMCE_SEV_FATAL:
227ed79ba9eSBenjamin Herrenschmidt 	default:
228ed79ba9eSBenjamin Herrenschmidt 		level = KERN_ERR;
229ed79ba9eSBenjamin Herrenschmidt 		sevstr = "Fatal";
230ed79ba9eSBenjamin Herrenschmidt 		break;
231ed79ba9eSBenjamin Herrenschmidt 	}
232ed79ba9eSBenjamin Herrenschmidt 
233ed79ba9eSBenjamin Herrenschmidt 	printk("%s%s Machine check interrupt [%s]\n", level, sevstr,
234ed79ba9eSBenjamin Herrenschmidt 	       evt.disposition == OpalMCE_DISPOSITION_RECOVERED ?
235ed79ba9eSBenjamin Herrenschmidt 	       "Recovered" : "[Not recovered");
236ed79ba9eSBenjamin Herrenschmidt 	printk("%s  Initiator: %s\n", level,
237ed79ba9eSBenjamin Herrenschmidt 	       evt.initiator == OpalMCE_INITIATOR_CPU ? "CPU" : "Unknown");
238ed79ba9eSBenjamin Herrenschmidt 	switch(evt.error_type) {
239ed79ba9eSBenjamin Herrenschmidt 	case OpalMCE_ERROR_TYPE_UE:
240ed79ba9eSBenjamin Herrenschmidt 		subtype = evt.u.ue_error.ue_error_type <
241ed79ba9eSBenjamin Herrenschmidt 			ARRAY_SIZE(opal_mc_ue_types) ?
242ed79ba9eSBenjamin Herrenschmidt 			opal_mc_ue_types[evt.u.ue_error.ue_error_type]
243ed79ba9eSBenjamin Herrenschmidt 			: "Unknown";
244ed79ba9eSBenjamin Herrenschmidt 		printk("%s  Error type: UE [%s]\n", level, subtype);
245ed79ba9eSBenjamin Herrenschmidt 		if (evt.u.ue_error.effective_address_provided)
246ed79ba9eSBenjamin Herrenschmidt 			printk("%s    Effective address: %016llx\n",
247ed79ba9eSBenjamin Herrenschmidt 			       level, evt.u.ue_error.effective_address);
248ed79ba9eSBenjamin Herrenschmidt 		if (evt.u.ue_error.physical_address_provided)
249ed79ba9eSBenjamin Herrenschmidt 			printk("%s      Physial address: %016llx\n",
250ed79ba9eSBenjamin Herrenschmidt 			       level, evt.u.ue_error.physical_address);
251ed79ba9eSBenjamin Herrenschmidt 		break;
252ed79ba9eSBenjamin Herrenschmidt 	case OpalMCE_ERROR_TYPE_SLB:
253ed79ba9eSBenjamin Herrenschmidt 		subtype = evt.u.slb_error.slb_error_type <
254ed79ba9eSBenjamin Herrenschmidt 			ARRAY_SIZE(opal_mc_slb_types) ?
255ed79ba9eSBenjamin Herrenschmidt 			opal_mc_slb_types[evt.u.slb_error.slb_error_type]
256ed79ba9eSBenjamin Herrenschmidt 			: "Unknown";
257ed79ba9eSBenjamin Herrenschmidt 		printk("%s  Error type: SLB [%s]\n", level, subtype);
258ed79ba9eSBenjamin Herrenschmidt 		if (evt.u.slb_error.effective_address_provided)
259ed79ba9eSBenjamin Herrenschmidt 			printk("%s    Effective address: %016llx\n",
260ed79ba9eSBenjamin Herrenschmidt 			       level, evt.u.slb_error.effective_address);
261ed79ba9eSBenjamin Herrenschmidt 		break;
262ed79ba9eSBenjamin Herrenschmidt 	case OpalMCE_ERROR_TYPE_ERAT:
263ed79ba9eSBenjamin Herrenschmidt 		subtype = evt.u.erat_error.erat_error_type <
264ed79ba9eSBenjamin Herrenschmidt 			ARRAY_SIZE(opal_mc_erat_types) ?
265ed79ba9eSBenjamin Herrenschmidt 			opal_mc_erat_types[evt.u.erat_error.erat_error_type]
266ed79ba9eSBenjamin Herrenschmidt 			: "Unknown";
267ed79ba9eSBenjamin Herrenschmidt 		printk("%s  Error type: ERAT [%s]\n", level, subtype);
268ed79ba9eSBenjamin Herrenschmidt 		if (evt.u.erat_error.effective_address_provided)
269ed79ba9eSBenjamin Herrenschmidt 			printk("%s    Effective address: %016llx\n",
270ed79ba9eSBenjamin Herrenschmidt 			       level, evt.u.erat_error.effective_address);
271ed79ba9eSBenjamin Herrenschmidt 		break;
272ed79ba9eSBenjamin Herrenschmidt 	case OpalMCE_ERROR_TYPE_TLB:
273ed79ba9eSBenjamin Herrenschmidt 		subtype = evt.u.tlb_error.tlb_error_type <
274ed79ba9eSBenjamin Herrenschmidt 			ARRAY_SIZE(opal_mc_tlb_types) ?
275ed79ba9eSBenjamin Herrenschmidt 			opal_mc_tlb_types[evt.u.tlb_error.tlb_error_type]
276ed79ba9eSBenjamin Herrenschmidt 			: "Unknown";
277ed79ba9eSBenjamin Herrenschmidt 		printk("%s  Error type: TLB [%s]\n", level, subtype);
278ed79ba9eSBenjamin Herrenschmidt 		if (evt.u.tlb_error.effective_address_provided)
279ed79ba9eSBenjamin Herrenschmidt 			printk("%s    Effective address: %016llx\n",
280ed79ba9eSBenjamin Herrenschmidt 			       level, evt.u.tlb_error.effective_address);
281ed79ba9eSBenjamin Herrenschmidt 		break;
282ed79ba9eSBenjamin Herrenschmidt 	default:
283ed79ba9eSBenjamin Herrenschmidt 	case OpalMCE_ERROR_TYPE_UNKNOWN:
284ed79ba9eSBenjamin Herrenschmidt 		printk("%s  Error type: Unknown\n", level);
285ed79ba9eSBenjamin Herrenschmidt 		break;
286ed79ba9eSBenjamin Herrenschmidt 	}
287ed79ba9eSBenjamin Herrenschmidt 	return evt.severity == OpalMCE_SEV_FATAL ? 0 : 1;
288ed79ba9eSBenjamin Herrenschmidt }
289ed79ba9eSBenjamin Herrenschmidt 
290a125e092SBenjamin Herrenschmidt static irqreturn_t opal_interrupt(int irq, void *data)
291a125e092SBenjamin Herrenschmidt {
292a125e092SBenjamin Herrenschmidt 	uint64_t events;
293a125e092SBenjamin Herrenschmidt 
294a125e092SBenjamin Herrenschmidt 	opal_handle_interrupt(virq_to_hw(irq), &events);
295a125e092SBenjamin Herrenschmidt 
296a125e092SBenjamin Herrenschmidt 	/* XXX TODO: Do something with the events */
297a125e092SBenjamin Herrenschmidt 
298a125e092SBenjamin Herrenschmidt 	return IRQ_HANDLED;
299a125e092SBenjamin Herrenschmidt }
300a125e092SBenjamin Herrenschmidt 
30114a43e69SBenjamin Herrenschmidt static int __init opal_init(void)
30214a43e69SBenjamin Herrenschmidt {
30314a43e69SBenjamin Herrenschmidt 	struct device_node *np, *consoles;
304a125e092SBenjamin Herrenschmidt 	const u32 *irqs;
305a125e092SBenjamin Herrenschmidt 	int rc, i, irqlen;
30614a43e69SBenjamin Herrenschmidt 
30714a43e69SBenjamin Herrenschmidt 	opal_node = of_find_node_by_path("/ibm,opal");
30814a43e69SBenjamin Herrenschmidt 	if (!opal_node) {
30914a43e69SBenjamin Herrenschmidt 		pr_warn("opal: Node not found\n");
31014a43e69SBenjamin Herrenschmidt 		return -ENODEV;
31114a43e69SBenjamin Herrenschmidt 	}
31214a43e69SBenjamin Herrenschmidt 	if (firmware_has_feature(FW_FEATURE_OPALv2))
31314a43e69SBenjamin Herrenschmidt 		consoles = of_find_node_by_path("/ibm,opal/consoles");
31414a43e69SBenjamin Herrenschmidt 	else
31514a43e69SBenjamin Herrenschmidt 		consoles = of_node_get(opal_node);
31614a43e69SBenjamin Herrenschmidt 
31714a43e69SBenjamin Herrenschmidt 	/* Register serial ports */
31814a43e69SBenjamin Herrenschmidt 	for_each_child_of_node(consoles, np) {
31914a43e69SBenjamin Herrenschmidt 		if (strcmp(np->name, "serial"))
32014a43e69SBenjamin Herrenschmidt 			continue;
32114a43e69SBenjamin Herrenschmidt 		of_platform_device_create(np, NULL, NULL);
32214a43e69SBenjamin Herrenschmidt 	}
32314a43e69SBenjamin Herrenschmidt 	of_node_put(consoles);
324a125e092SBenjamin Herrenschmidt 
325a125e092SBenjamin Herrenschmidt 	/* Find all OPAL interrupts and request them */
326a125e092SBenjamin Herrenschmidt 	irqs = of_get_property(opal_node, "opal-interrupts", &irqlen);
327a125e092SBenjamin Herrenschmidt 	pr_debug("opal: Found %d interrupts reserved for OPAL\n",
328a125e092SBenjamin Herrenschmidt 		 irqs ? (irqlen / 4) : 0);
32973ed148aSBenjamin Herrenschmidt 	opal_irq_count = irqlen / 4;
33073ed148aSBenjamin Herrenschmidt 	opal_irqs = kzalloc(opal_irq_count * sizeof(unsigned int), GFP_KERNEL);
331a125e092SBenjamin Herrenschmidt 	for (i = 0; irqs && i < (irqlen / 4); i++, irqs++) {
332a125e092SBenjamin Herrenschmidt 		unsigned int hwirq = be32_to_cpup(irqs);
333a125e092SBenjamin Herrenschmidt 		unsigned int irq = irq_create_mapping(NULL, hwirq);
334a125e092SBenjamin Herrenschmidt 		if (irq == NO_IRQ) {
335a125e092SBenjamin Herrenschmidt 			pr_warning("opal: Failed to map irq 0x%x\n", hwirq);
336a125e092SBenjamin Herrenschmidt 			continue;
337a125e092SBenjamin Herrenschmidt 		}
338a125e092SBenjamin Herrenschmidt 		rc = request_irq(irq, opal_interrupt, 0, "opal", NULL);
339a125e092SBenjamin Herrenschmidt 		if (rc)
340a125e092SBenjamin Herrenschmidt 			pr_warning("opal: Error %d requesting irq %d"
341a125e092SBenjamin Herrenschmidt 				   " (0x%x)\n", rc, irq, hwirq);
34273ed148aSBenjamin Herrenschmidt 		opal_irqs[i] = irq;
343a125e092SBenjamin Herrenschmidt 	}
34414a43e69SBenjamin Herrenschmidt 	return 0;
34514a43e69SBenjamin Herrenschmidt }
34614a43e69SBenjamin Herrenschmidt subsys_initcall(opal_init);
34773ed148aSBenjamin Herrenschmidt 
34873ed148aSBenjamin Herrenschmidt void opal_shutdown(void)
34973ed148aSBenjamin Herrenschmidt {
35073ed148aSBenjamin Herrenschmidt 	unsigned int i;
35173ed148aSBenjamin Herrenschmidt 
35273ed148aSBenjamin Herrenschmidt 	for (i = 0; i < opal_irq_count; i++) {
35373ed148aSBenjamin Herrenschmidt 		if (opal_irqs[i])
35473ed148aSBenjamin Herrenschmidt 			free_irq(opal_irqs[i], 0);
35573ed148aSBenjamin Herrenschmidt 		opal_irqs[i] = 0;
35673ed148aSBenjamin Herrenschmidt 	}
35773ed148aSBenjamin Herrenschmidt }
358