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