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> 1626a2056eSRob Herring #include <linux/of_fdt.h> 1714a43e69SBenjamin Herrenschmidt #include <linux/of_platform.h> 18a125e092SBenjamin Herrenschmidt #include <linux/interrupt.h> 191bc98de2SGavin Shan #include <linux/notifier.h> 2073ed148aSBenjamin Herrenschmidt #include <linux/slab.h> 21b63a0ffeSMahesh Salgaonkar #include <linux/sched.h> 226f68b5e2SVasant Hegde #include <linux/kobject.h> 23f7d98d18SVasant Hegde #include <linux/delay.h> 2455672ecfSMahesh Salgaonkar #include <linux/memblock.h> 2514a43e69SBenjamin Herrenschmidt #include <asm/opal.h> 2614a43e69SBenjamin Herrenschmidt #include <asm/firmware.h> 2736df96f8SMahesh Salgaonkar #include <asm/mce.h> 2814a43e69SBenjamin Herrenschmidt 2914a43e69SBenjamin Herrenschmidt #include "powernv.h" 3014a43e69SBenjamin Herrenschmidt 316f68b5e2SVasant Hegde /* /sys/firmware/opal */ 326f68b5e2SVasant Hegde struct kobject *opal_kobj; 336f68b5e2SVasant Hegde 3414a43e69SBenjamin Herrenschmidt struct opal { 3514a43e69SBenjamin Herrenschmidt u64 base; 3614a43e69SBenjamin Herrenschmidt u64 entry; 3755672ecfSMahesh Salgaonkar u64 size; 3814a43e69SBenjamin Herrenschmidt } opal; 3914a43e69SBenjamin Herrenschmidt 4055672ecfSMahesh Salgaonkar struct mcheck_recoverable_range { 4155672ecfSMahesh Salgaonkar u64 start_addr; 4255672ecfSMahesh Salgaonkar u64 end_addr; 4355672ecfSMahesh Salgaonkar u64 recover_addr; 4455672ecfSMahesh Salgaonkar }; 4555672ecfSMahesh Salgaonkar 4655672ecfSMahesh Salgaonkar static struct mcheck_recoverable_range *mc_recoverable_range; 4755672ecfSMahesh Salgaonkar static int mc_recoverable_range_len; 4855672ecfSMahesh Salgaonkar 49bfc36894SJoel Stanley struct device_node *opal_node; 5014a43e69SBenjamin Herrenschmidt static DEFINE_SPINLOCK(opal_write_lock); 51ed79ba9eSBenjamin Herrenschmidt extern u64 opal_mc_secondary_handler[]; 5273ed148aSBenjamin Herrenschmidt static unsigned int *opal_irqs; 5373ed148aSBenjamin Herrenschmidt static unsigned int opal_irq_count; 541bc98de2SGavin Shan static ATOMIC_NOTIFIER_HEAD(opal_notifier_head); 5524366360SMahesh Salgaonkar static struct atomic_notifier_head opal_msg_notifier_head[OPAL_MSG_TYPE_MAX]; 561bc98de2SGavin Shan static DEFINE_SPINLOCK(opal_notifier_lock); 571bc98de2SGavin Shan static uint64_t last_notified_mask = 0x0ul; 581bc98de2SGavin Shan static atomic_t opal_notifier_hold = ATOMIC_INIT(0); 5914a43e69SBenjamin Herrenschmidt 604926616cSBenjamin Herrenschmidt static void opal_reinit_cores(void) 614926616cSBenjamin Herrenschmidt { 624926616cSBenjamin Herrenschmidt /* Do the actual re-init, This will clobber all FPRs, VRs, etc... 634926616cSBenjamin Herrenschmidt * 644926616cSBenjamin Herrenschmidt * It will preserve non volatile GPRs and HSPRG0/1. It will 654926616cSBenjamin Herrenschmidt * also restore HIDs and other SPRs to their original value 664926616cSBenjamin Herrenschmidt * but it might clobber a bunch. 674926616cSBenjamin Herrenschmidt */ 684926616cSBenjamin Herrenschmidt #ifdef __BIG_ENDIAN__ 694926616cSBenjamin Herrenschmidt opal_reinit_cpus(OPAL_REINIT_CPUS_HILE_BE); 704926616cSBenjamin Herrenschmidt #else 714926616cSBenjamin Herrenschmidt opal_reinit_cpus(OPAL_REINIT_CPUS_HILE_LE); 724926616cSBenjamin Herrenschmidt #endif 734926616cSBenjamin Herrenschmidt } 744926616cSBenjamin Herrenschmidt 7514a43e69SBenjamin Herrenschmidt int __init early_init_dt_scan_opal(unsigned long node, 7614a43e69SBenjamin Herrenschmidt const char *uname, int depth, void *data) 7714a43e69SBenjamin Herrenschmidt { 7855672ecfSMahesh Salgaonkar const void *basep, *entryp, *sizep; 7955672ecfSMahesh Salgaonkar unsigned long basesz, entrysz, runtimesz; 8014a43e69SBenjamin Herrenschmidt 8114a43e69SBenjamin Herrenschmidt if (depth != 1 || strcmp(uname, "ibm,opal") != 0) 8214a43e69SBenjamin Herrenschmidt return 0; 8314a43e69SBenjamin Herrenschmidt 8414a43e69SBenjamin Herrenschmidt basep = of_get_flat_dt_prop(node, "opal-base-address", &basesz); 8514a43e69SBenjamin Herrenschmidt entryp = of_get_flat_dt_prop(node, "opal-entry-address", &entrysz); 8655672ecfSMahesh Salgaonkar sizep = of_get_flat_dt_prop(node, "opal-runtime-size", &runtimesz); 8714a43e69SBenjamin Herrenschmidt 8855672ecfSMahesh Salgaonkar if (!basep || !entryp || !sizep) 8914a43e69SBenjamin Herrenschmidt return 1; 9014a43e69SBenjamin Herrenschmidt 9114a43e69SBenjamin Herrenschmidt opal.base = of_read_number(basep, basesz/4); 9214a43e69SBenjamin Herrenschmidt opal.entry = of_read_number(entryp, entrysz/4); 9355672ecfSMahesh Salgaonkar opal.size = of_read_number(sizep, runtimesz/4); 9414a43e69SBenjamin Herrenschmidt 9514a43e69SBenjamin Herrenschmidt pr_debug("OPAL Base = 0x%llx (basep=%p basesz=%ld)\n", 9614a43e69SBenjamin Herrenschmidt opal.base, basep, basesz); 9714a43e69SBenjamin Herrenschmidt pr_debug("OPAL Entry = 0x%llx (entryp=%p basesz=%ld)\n", 9814a43e69SBenjamin Herrenschmidt opal.entry, entryp, entrysz); 9955672ecfSMahesh Salgaonkar pr_debug("OPAL Entry = 0x%llx (sizep=%p runtimesz=%ld)\n", 10055672ecfSMahesh Salgaonkar opal.size, sizep, runtimesz); 10114a43e69SBenjamin Herrenschmidt 10214a43e69SBenjamin Herrenschmidt powerpc_firmware_features |= FW_FEATURE_OPAL; 10375b93da4SBenjamin Herrenschmidt if (of_flat_dt_is_compatible(node, "ibm,opal-v3")) { 10475b93da4SBenjamin Herrenschmidt powerpc_firmware_features |= FW_FEATURE_OPALv2; 10575b93da4SBenjamin Herrenschmidt powerpc_firmware_features |= FW_FEATURE_OPALv3; 10675b93da4SBenjamin Herrenschmidt printk("OPAL V3 detected !\n"); 10775b93da4SBenjamin Herrenschmidt } else if (of_flat_dt_is_compatible(node, "ibm,opal-v2")) { 10814a43e69SBenjamin Herrenschmidt powerpc_firmware_features |= FW_FEATURE_OPALv2; 10914a43e69SBenjamin Herrenschmidt printk("OPAL V2 detected !\n"); 11014a43e69SBenjamin Herrenschmidt } else { 11114a43e69SBenjamin Herrenschmidt printk("OPAL V1 detected !\n"); 11214a43e69SBenjamin Herrenschmidt } 11314a43e69SBenjamin Herrenschmidt 1144926616cSBenjamin Herrenschmidt /* Reinit all cores with the right endian */ 1154926616cSBenjamin Herrenschmidt opal_reinit_cores(); 1164926616cSBenjamin Herrenschmidt 1174926616cSBenjamin Herrenschmidt /* Restore some bits */ 1184926616cSBenjamin Herrenschmidt if (cur_cpu_spec->cpu_restore) 1194926616cSBenjamin Herrenschmidt cur_cpu_spec->cpu_restore(); 1204926616cSBenjamin Herrenschmidt 121c4463b37SJeremy Kerr return 1; 122c4463b37SJeremy Kerr } 123c4463b37SJeremy Kerr 12455672ecfSMahesh Salgaonkar int __init early_init_dt_scan_recoverable_ranges(unsigned long node, 12555672ecfSMahesh Salgaonkar const char *uname, int depth, void *data) 12655672ecfSMahesh Salgaonkar { 1276e556b47SMahesh Salgaonkar unsigned long i, psize, size; 12855672ecfSMahesh Salgaonkar const __be32 *prop; 12955672ecfSMahesh Salgaonkar 13055672ecfSMahesh Salgaonkar if (depth != 1 || strcmp(uname, "ibm,opal") != 0) 13155672ecfSMahesh Salgaonkar return 0; 13255672ecfSMahesh Salgaonkar 1336e556b47SMahesh Salgaonkar prop = of_get_flat_dt_prop(node, "mcheck-recoverable-ranges", &psize); 13455672ecfSMahesh Salgaonkar 13555672ecfSMahesh Salgaonkar if (!prop) 13655672ecfSMahesh Salgaonkar return 1; 13755672ecfSMahesh Salgaonkar 13855672ecfSMahesh Salgaonkar pr_debug("Found machine check recoverable ranges.\n"); 13955672ecfSMahesh Salgaonkar 14055672ecfSMahesh Salgaonkar /* 1416e556b47SMahesh Salgaonkar * Calculate number of available entries. 1426e556b47SMahesh Salgaonkar * 1436e556b47SMahesh Salgaonkar * Each recoverable address range entry is (start address, len, 1446e556b47SMahesh Salgaonkar * recovery address), 2 cells each for start and recovery address, 1456e556b47SMahesh Salgaonkar * 1 cell for len, totalling 5 cells per entry. 1466e556b47SMahesh Salgaonkar */ 1476e556b47SMahesh Salgaonkar mc_recoverable_range_len = psize / (sizeof(*prop) * 5); 1486e556b47SMahesh Salgaonkar 1496e556b47SMahesh Salgaonkar /* Sanity check */ 1506e556b47SMahesh Salgaonkar if (!mc_recoverable_range_len) 1516e556b47SMahesh Salgaonkar return 1; 1526e556b47SMahesh Salgaonkar 1536e556b47SMahesh Salgaonkar /* Size required to hold all the entries. */ 1546e556b47SMahesh Salgaonkar size = mc_recoverable_range_len * 1556e556b47SMahesh Salgaonkar sizeof(struct mcheck_recoverable_range); 1566e556b47SMahesh Salgaonkar 1576e556b47SMahesh Salgaonkar /* 15855672ecfSMahesh Salgaonkar * Allocate a buffer to hold the MC recoverable ranges. We would be 15955672ecfSMahesh Salgaonkar * accessing them in real mode, hence it needs to be within 16055672ecfSMahesh Salgaonkar * RMO region. 16155672ecfSMahesh Salgaonkar */ 16255672ecfSMahesh Salgaonkar mc_recoverable_range =__va(memblock_alloc_base(size, __alignof__(u64), 16355672ecfSMahesh Salgaonkar ppc64_rma_size)); 16455672ecfSMahesh Salgaonkar memset(mc_recoverable_range, 0, size); 16555672ecfSMahesh Salgaonkar 1666e556b47SMahesh Salgaonkar for (i = 0; i < mc_recoverable_range_len; i++) { 16755672ecfSMahesh Salgaonkar mc_recoverable_range[i].start_addr = 16855672ecfSMahesh Salgaonkar of_read_number(prop + (i * 5) + 0, 2); 16955672ecfSMahesh Salgaonkar mc_recoverable_range[i].end_addr = 17055672ecfSMahesh Salgaonkar mc_recoverable_range[i].start_addr + 17155672ecfSMahesh Salgaonkar of_read_number(prop + (i * 5) + 2, 1); 17255672ecfSMahesh Salgaonkar mc_recoverable_range[i].recover_addr = 17355672ecfSMahesh Salgaonkar of_read_number(prop + (i * 5) + 3, 2); 17455672ecfSMahesh Salgaonkar 17555672ecfSMahesh Salgaonkar pr_debug("Machine check recoverable range: %llx..%llx: %llx\n", 17655672ecfSMahesh Salgaonkar mc_recoverable_range[i].start_addr, 17755672ecfSMahesh Salgaonkar mc_recoverable_range[i].end_addr, 17855672ecfSMahesh Salgaonkar mc_recoverable_range[i].recover_addr); 17955672ecfSMahesh Salgaonkar } 18055672ecfSMahesh Salgaonkar return 1; 18155672ecfSMahesh Salgaonkar } 18255672ecfSMahesh Salgaonkar 183c4463b37SJeremy Kerr static int __init opal_register_exception_handlers(void) 184c4463b37SJeremy Kerr { 18529186097SBenjamin Herrenschmidt #ifdef __BIG_ENDIAN__ 186c4463b37SJeremy Kerr u64 glue; 187c4463b37SJeremy Kerr 188c4463b37SJeremy Kerr if (!(powerpc_firmware_features & FW_FEATURE_OPAL)) 189c4463b37SJeremy Kerr return -ENODEV; 190c4463b37SJeremy Kerr 19128446de2SMahesh Salgaonkar /* Hookup some exception handlers except machine check. We use the 19228446de2SMahesh Salgaonkar * fwnmi area at 0x7000 to provide the glue space to OPAL 193ed79ba9eSBenjamin Herrenschmidt */ 194ed79ba9eSBenjamin Herrenschmidt glue = 0x7000; 195ed79ba9eSBenjamin Herrenschmidt opal_register_exception_handler(OPAL_HYPERVISOR_MAINTENANCE_HANDLER, 196ed79ba9eSBenjamin Herrenschmidt 0, glue); 197ed79ba9eSBenjamin Herrenschmidt glue += 128; 198ed79ba9eSBenjamin Herrenschmidt opal_register_exception_handler(OPAL_SOFTPATCH_HANDLER, 0, glue); 19929186097SBenjamin Herrenschmidt #endif 200ed79ba9eSBenjamin Herrenschmidt 201c4463b37SJeremy Kerr return 0; 20214a43e69SBenjamin Herrenschmidt } 20314a43e69SBenjamin Herrenschmidt 204c4463b37SJeremy Kerr early_initcall(opal_register_exception_handlers); 205c4463b37SJeremy Kerr 2061bc98de2SGavin Shan int opal_notifier_register(struct notifier_block *nb) 2071bc98de2SGavin Shan { 2081bc98de2SGavin Shan if (!nb) { 2091bc98de2SGavin Shan pr_warning("%s: Invalid argument (%p)\n", 2101bc98de2SGavin Shan __func__, nb); 2111bc98de2SGavin Shan return -EINVAL; 2121bc98de2SGavin Shan } 2131bc98de2SGavin Shan 2141bc98de2SGavin Shan atomic_notifier_chain_register(&opal_notifier_head, nb); 2151bc98de2SGavin Shan return 0; 2161bc98de2SGavin Shan } 217798af00cSBenjamin Herrenschmidt EXPORT_SYMBOL_GPL(opal_notifier_register); 218798af00cSBenjamin Herrenschmidt 219798af00cSBenjamin Herrenschmidt int opal_notifier_unregister(struct notifier_block *nb) 220798af00cSBenjamin Herrenschmidt { 221798af00cSBenjamin Herrenschmidt if (!nb) { 222798af00cSBenjamin Herrenschmidt pr_warning("%s: Invalid argument (%p)\n", 223798af00cSBenjamin Herrenschmidt __func__, nb); 224798af00cSBenjamin Herrenschmidt return -EINVAL; 225798af00cSBenjamin Herrenschmidt } 226798af00cSBenjamin Herrenschmidt 227798af00cSBenjamin Herrenschmidt atomic_notifier_chain_unregister(&opal_notifier_head, nb); 228798af00cSBenjamin Herrenschmidt return 0; 229798af00cSBenjamin Herrenschmidt } 230798af00cSBenjamin Herrenschmidt EXPORT_SYMBOL_GPL(opal_notifier_unregister); 2311bc98de2SGavin Shan 2321bc98de2SGavin Shan static void opal_do_notifier(uint64_t events) 2331bc98de2SGavin Shan { 2341bc98de2SGavin Shan unsigned long flags; 2351bc98de2SGavin Shan uint64_t changed_mask; 2361bc98de2SGavin Shan 2371bc98de2SGavin Shan if (atomic_read(&opal_notifier_hold)) 2381bc98de2SGavin Shan return; 2391bc98de2SGavin Shan 2401bc98de2SGavin Shan spin_lock_irqsave(&opal_notifier_lock, flags); 2411bc98de2SGavin Shan changed_mask = last_notified_mask ^ events; 2421bc98de2SGavin Shan last_notified_mask = events; 2431bc98de2SGavin Shan spin_unlock_irqrestore(&opal_notifier_lock, flags); 2441bc98de2SGavin Shan 2451bc98de2SGavin Shan /* 2461bc98de2SGavin Shan * We feed with the event bits and changed bits for 2471bc98de2SGavin Shan * enough information to the callback. 2481bc98de2SGavin Shan */ 2491bc98de2SGavin Shan atomic_notifier_call_chain(&opal_notifier_head, 2501bc98de2SGavin Shan events, (void *)changed_mask); 2511bc98de2SGavin Shan } 2521bc98de2SGavin Shan 2531bc98de2SGavin Shan void opal_notifier_update_evt(uint64_t evt_mask, 2541bc98de2SGavin Shan uint64_t evt_val) 2551bc98de2SGavin Shan { 2561bc98de2SGavin Shan unsigned long flags; 2571bc98de2SGavin Shan 2581bc98de2SGavin Shan spin_lock_irqsave(&opal_notifier_lock, flags); 2591bc98de2SGavin Shan last_notified_mask &= ~evt_mask; 2601bc98de2SGavin Shan last_notified_mask |= evt_val; 2611bc98de2SGavin Shan spin_unlock_irqrestore(&opal_notifier_lock, flags); 2621bc98de2SGavin Shan } 2631bc98de2SGavin Shan 2641bc98de2SGavin Shan void opal_notifier_enable(void) 2651bc98de2SGavin Shan { 2661bc98de2SGavin Shan int64_t rc; 26756b4c993SAnton Blanchard __be64 evt = 0; 2681bc98de2SGavin Shan 2691bc98de2SGavin Shan atomic_set(&opal_notifier_hold, 0); 2701bc98de2SGavin Shan 2711bc98de2SGavin Shan /* Process pending events */ 2721bc98de2SGavin Shan rc = opal_poll_events(&evt); 2731bc98de2SGavin Shan if (rc == OPAL_SUCCESS && evt) 27456b4c993SAnton Blanchard opal_do_notifier(be64_to_cpu(evt)); 2751bc98de2SGavin Shan } 2761bc98de2SGavin Shan 2771bc98de2SGavin Shan void opal_notifier_disable(void) 2781bc98de2SGavin Shan { 2791bc98de2SGavin Shan atomic_set(&opal_notifier_hold, 1); 2801bc98de2SGavin Shan } 2811bc98de2SGavin Shan 28224366360SMahesh Salgaonkar /* 28324366360SMahesh Salgaonkar * Opal message notifier based on message type. Allow subscribers to get 28424366360SMahesh Salgaonkar * notified for specific messgae type. 28524366360SMahesh Salgaonkar */ 28624366360SMahesh Salgaonkar int opal_message_notifier_register(enum OpalMessageType msg_type, 28724366360SMahesh Salgaonkar struct notifier_block *nb) 28824366360SMahesh Salgaonkar { 28924366360SMahesh Salgaonkar if (!nb) { 29024366360SMahesh Salgaonkar pr_warning("%s: Invalid argument (%p)\n", 29124366360SMahesh Salgaonkar __func__, nb); 29224366360SMahesh Salgaonkar return -EINVAL; 29324366360SMahesh Salgaonkar } 29424366360SMahesh Salgaonkar if (msg_type > OPAL_MSG_TYPE_MAX) { 29524366360SMahesh Salgaonkar pr_warning("%s: Invalid message type argument (%d)\n", 29624366360SMahesh Salgaonkar __func__, msg_type); 29724366360SMahesh Salgaonkar return -EINVAL; 29824366360SMahesh Salgaonkar } 29924366360SMahesh Salgaonkar return atomic_notifier_chain_register( 30024366360SMahesh Salgaonkar &opal_msg_notifier_head[msg_type], nb); 30124366360SMahesh Salgaonkar } 30224366360SMahesh Salgaonkar 30324366360SMahesh Salgaonkar static void opal_message_do_notify(uint32_t msg_type, void *msg) 30424366360SMahesh Salgaonkar { 30524366360SMahesh Salgaonkar /* notify subscribers */ 30624366360SMahesh Salgaonkar atomic_notifier_call_chain(&opal_msg_notifier_head[msg_type], 30724366360SMahesh Salgaonkar msg_type, msg); 30824366360SMahesh Salgaonkar } 30924366360SMahesh Salgaonkar 31024366360SMahesh Salgaonkar static void opal_handle_message(void) 31124366360SMahesh Salgaonkar { 31224366360SMahesh Salgaonkar s64 ret; 31324366360SMahesh Salgaonkar /* 31424366360SMahesh Salgaonkar * TODO: pre-allocate a message buffer depending on opal-msg-size 31524366360SMahesh Salgaonkar * value in /proc/device-tree. 31624366360SMahesh Salgaonkar */ 31724366360SMahesh Salgaonkar static struct opal_msg msg; 318bb4398e1SAnton Blanchard u32 type; 31924366360SMahesh Salgaonkar 32024366360SMahesh Salgaonkar ret = opal_get_msg(__pa(&msg), sizeof(msg)); 32124366360SMahesh Salgaonkar /* No opal message pending. */ 32224366360SMahesh Salgaonkar if (ret == OPAL_RESOURCE) 32324366360SMahesh Salgaonkar return; 32424366360SMahesh Salgaonkar 32524366360SMahesh Salgaonkar /* check for errors. */ 32624366360SMahesh Salgaonkar if (ret) { 32724366360SMahesh Salgaonkar pr_warning("%s: Failed to retrive opal message, err=%lld\n", 32824366360SMahesh Salgaonkar __func__, ret); 32924366360SMahesh Salgaonkar return; 33024366360SMahesh Salgaonkar } 33124366360SMahesh Salgaonkar 332bb4398e1SAnton Blanchard type = be32_to_cpu(msg.msg_type); 333bb4398e1SAnton Blanchard 33424366360SMahesh Salgaonkar /* Sanity check */ 335bb4398e1SAnton Blanchard if (type > OPAL_MSG_TYPE_MAX) { 336bb4398e1SAnton Blanchard pr_warning("%s: Unknown message type: %u\n", __func__, type); 33724366360SMahesh Salgaonkar return; 33824366360SMahesh Salgaonkar } 339bb4398e1SAnton Blanchard opal_message_do_notify(type, (void *)&msg); 34024366360SMahesh Salgaonkar } 34124366360SMahesh Salgaonkar 34224366360SMahesh Salgaonkar static int opal_message_notify(struct notifier_block *nb, 34324366360SMahesh Salgaonkar unsigned long events, void *change) 34424366360SMahesh Salgaonkar { 34524366360SMahesh Salgaonkar if (events & OPAL_EVENT_MSG_PENDING) 34624366360SMahesh Salgaonkar opal_handle_message(); 34724366360SMahesh Salgaonkar return 0; 34824366360SMahesh Salgaonkar } 34924366360SMahesh Salgaonkar 35024366360SMahesh Salgaonkar static struct notifier_block opal_message_nb = { 35124366360SMahesh Salgaonkar .notifier_call = opal_message_notify, 35224366360SMahesh Salgaonkar .next = NULL, 35324366360SMahesh Salgaonkar .priority = 0, 35424366360SMahesh Salgaonkar }; 35524366360SMahesh Salgaonkar 35624366360SMahesh Salgaonkar static int __init opal_message_init(void) 35724366360SMahesh Salgaonkar { 35824366360SMahesh Salgaonkar int ret, i; 35924366360SMahesh Salgaonkar 36024366360SMahesh Salgaonkar for (i = 0; i < OPAL_MSG_TYPE_MAX; i++) 36124366360SMahesh Salgaonkar ATOMIC_INIT_NOTIFIER_HEAD(&opal_msg_notifier_head[i]); 36224366360SMahesh Salgaonkar 36324366360SMahesh Salgaonkar ret = opal_notifier_register(&opal_message_nb); 36424366360SMahesh Salgaonkar if (ret) { 36524366360SMahesh Salgaonkar pr_err("%s: Can't register OPAL event notifier (%d)\n", 36624366360SMahesh Salgaonkar __func__, ret); 36724366360SMahesh Salgaonkar return ret; 36824366360SMahesh Salgaonkar } 36924366360SMahesh Salgaonkar return 0; 37024366360SMahesh Salgaonkar } 37124366360SMahesh Salgaonkar early_initcall(opal_message_init); 37224366360SMahesh Salgaonkar 37314a43e69SBenjamin Herrenschmidt int opal_get_chars(uint32_t vtermno, char *buf, int count) 37414a43e69SBenjamin Herrenschmidt { 3754f89363bSBenjamin Herrenschmidt s64 rc; 3764f89363bSBenjamin Herrenschmidt __be64 evt, len; 37714a43e69SBenjamin Herrenschmidt 37814a43e69SBenjamin Herrenschmidt if (!opal.entry) 379daea1175SBenjamin Herrenschmidt return -ENODEV; 38014a43e69SBenjamin Herrenschmidt opal_poll_events(&evt); 3814f89363bSBenjamin Herrenschmidt if ((be64_to_cpu(evt) & OPAL_EVENT_CONSOLE_INPUT) == 0) 38214a43e69SBenjamin Herrenschmidt return 0; 3834f89363bSBenjamin Herrenschmidt len = cpu_to_be64(count); 38414a43e69SBenjamin Herrenschmidt rc = opal_console_read(vtermno, &len, buf); 38514a43e69SBenjamin Herrenschmidt if (rc == OPAL_SUCCESS) 3864f89363bSBenjamin Herrenschmidt return be64_to_cpu(len); 38714a43e69SBenjamin Herrenschmidt return 0; 38814a43e69SBenjamin Herrenschmidt } 38914a43e69SBenjamin Herrenschmidt 39014a43e69SBenjamin Herrenschmidt int opal_put_chars(uint32_t vtermno, const char *data, int total_len) 39114a43e69SBenjamin Herrenschmidt { 39214a43e69SBenjamin Herrenschmidt int written = 0; 3934f89363bSBenjamin Herrenschmidt __be64 olen; 394daea1175SBenjamin Herrenschmidt s64 len, rc; 39514a43e69SBenjamin Herrenschmidt unsigned long flags; 3964f89363bSBenjamin Herrenschmidt __be64 evt; 39714a43e69SBenjamin Herrenschmidt 39814a43e69SBenjamin Herrenschmidt if (!opal.entry) 399daea1175SBenjamin Herrenschmidt return -ENODEV; 40014a43e69SBenjamin Herrenschmidt 40114a43e69SBenjamin Herrenschmidt /* We want put_chars to be atomic to avoid mangling of hvsi 40214a43e69SBenjamin Herrenschmidt * packets. To do that, we first test for room and return 403daea1175SBenjamin Herrenschmidt * -EAGAIN if there isn't enough. 404daea1175SBenjamin Herrenschmidt * 405daea1175SBenjamin Herrenschmidt * Unfortunately, opal_console_write_buffer_space() doesn't 406daea1175SBenjamin Herrenschmidt * appear to work on opal v1, so we just assume there is 407daea1175SBenjamin Herrenschmidt * enough room and be done with it 40814a43e69SBenjamin Herrenschmidt */ 40914a43e69SBenjamin Herrenschmidt spin_lock_irqsave(&opal_write_lock, flags); 410daea1175SBenjamin Herrenschmidt if (firmware_has_feature(FW_FEATURE_OPALv2)) { 4114f89363bSBenjamin Herrenschmidt rc = opal_console_write_buffer_space(vtermno, &olen); 4124f89363bSBenjamin Herrenschmidt len = be64_to_cpu(olen); 41314a43e69SBenjamin Herrenschmidt if (rc || len < total_len) { 41414a43e69SBenjamin Herrenschmidt spin_unlock_irqrestore(&opal_write_lock, flags); 41514a43e69SBenjamin Herrenschmidt /* Closed -> drop characters */ 41614a43e69SBenjamin Herrenschmidt if (rc) 41714a43e69SBenjamin Herrenschmidt return total_len; 4184f89363bSBenjamin Herrenschmidt opal_poll_events(NULL); 41914a43e69SBenjamin Herrenschmidt return -EAGAIN; 42014a43e69SBenjamin Herrenschmidt } 421daea1175SBenjamin Herrenschmidt } 42214a43e69SBenjamin Herrenschmidt 42314a43e69SBenjamin Herrenschmidt /* We still try to handle partial completions, though they 42414a43e69SBenjamin Herrenschmidt * should no longer happen. 42514a43e69SBenjamin Herrenschmidt */ 426daea1175SBenjamin Herrenschmidt rc = OPAL_BUSY; 42714a43e69SBenjamin Herrenschmidt while(total_len > 0 && (rc == OPAL_BUSY || 42814a43e69SBenjamin Herrenschmidt rc == OPAL_BUSY_EVENT || rc == OPAL_SUCCESS)) { 4294f89363bSBenjamin Herrenschmidt olen = cpu_to_be64(total_len); 4304f89363bSBenjamin Herrenschmidt rc = opal_console_write(vtermno, &olen, data); 4314f89363bSBenjamin Herrenschmidt len = be64_to_cpu(olen); 4321de1455fSBenjamin Herrenschmidt 4331de1455fSBenjamin Herrenschmidt /* Closed or other error drop */ 4341de1455fSBenjamin Herrenschmidt if (rc != OPAL_SUCCESS && rc != OPAL_BUSY && 4351de1455fSBenjamin Herrenschmidt rc != OPAL_BUSY_EVENT) { 4361de1455fSBenjamin Herrenschmidt written = total_len; 4371de1455fSBenjamin Herrenschmidt break; 4381de1455fSBenjamin Herrenschmidt } 43914a43e69SBenjamin Herrenschmidt if (rc == OPAL_SUCCESS) { 44014a43e69SBenjamin Herrenschmidt total_len -= len; 44114a43e69SBenjamin Herrenschmidt data += len; 44214a43e69SBenjamin Herrenschmidt written += len; 44314a43e69SBenjamin Herrenschmidt } 44414a43e69SBenjamin Herrenschmidt /* This is a bit nasty but we need that for the console to 44514a43e69SBenjamin Herrenschmidt * flush when there aren't any interrupts. We will clean 44614a43e69SBenjamin Herrenschmidt * things a bit later to limit that to synchronous path 44714a43e69SBenjamin Herrenschmidt * such as the kernel console and xmon/udbg 44814a43e69SBenjamin Herrenschmidt */ 44914a43e69SBenjamin Herrenschmidt do 45014a43e69SBenjamin Herrenschmidt opal_poll_events(&evt); 4514f89363bSBenjamin Herrenschmidt while(rc == OPAL_SUCCESS && 4524f89363bSBenjamin Herrenschmidt (be64_to_cpu(evt) & OPAL_EVENT_CONSOLE_OUTPUT)); 45314a43e69SBenjamin Herrenschmidt } 45414a43e69SBenjamin Herrenschmidt spin_unlock_irqrestore(&opal_write_lock, flags); 45514a43e69SBenjamin Herrenschmidt return written; 45614a43e69SBenjamin Herrenschmidt } 45714a43e69SBenjamin Herrenschmidt 458b63a0ffeSMahesh Salgaonkar static int opal_recover_mce(struct pt_regs *regs, 459b63a0ffeSMahesh Salgaonkar struct machine_check_event *evt) 460b63a0ffeSMahesh Salgaonkar { 461b63a0ffeSMahesh Salgaonkar int recovered = 0; 462b63a0ffeSMahesh Salgaonkar uint64_t ea = get_mce_fault_addr(evt); 463b63a0ffeSMahesh Salgaonkar 464b63a0ffeSMahesh Salgaonkar if (!(regs->msr & MSR_RI)) { 465b63a0ffeSMahesh Salgaonkar /* If MSR_RI isn't set, we cannot recover */ 466b63a0ffeSMahesh Salgaonkar recovered = 0; 467b63a0ffeSMahesh Salgaonkar } else if (evt->disposition == MCE_DISPOSITION_RECOVERED) { 468b63a0ffeSMahesh Salgaonkar /* Platform corrected itself */ 469b63a0ffeSMahesh Salgaonkar recovered = 1; 470b63a0ffeSMahesh Salgaonkar } else if (ea && !is_kernel_addr(ea)) { 471b63a0ffeSMahesh Salgaonkar /* 472b63a0ffeSMahesh Salgaonkar * Faulting address is not in kernel text. We should be fine. 473b63a0ffeSMahesh Salgaonkar * We need to find which process uses this address. 474b63a0ffeSMahesh Salgaonkar * For now, kill the task if we have received exception when 475b63a0ffeSMahesh Salgaonkar * in userspace. 476b63a0ffeSMahesh Salgaonkar * 477b63a0ffeSMahesh Salgaonkar * TODO: Queue up this address for hwpoisioning later. 478b63a0ffeSMahesh Salgaonkar */ 479b63a0ffeSMahesh Salgaonkar if (user_mode(regs) && !is_global_init(current)) { 480b63a0ffeSMahesh Salgaonkar _exception(SIGBUS, regs, BUS_MCEERR_AR, regs->nip); 481b63a0ffeSMahesh Salgaonkar recovered = 1; 482b63a0ffeSMahesh Salgaonkar } else 483b63a0ffeSMahesh Salgaonkar recovered = 0; 484b63a0ffeSMahesh Salgaonkar } else if (user_mode(regs) && !is_global_init(current) && 485b63a0ffeSMahesh Salgaonkar evt->severity == MCE_SEV_ERROR_SYNC) { 486b63a0ffeSMahesh Salgaonkar /* 487b63a0ffeSMahesh Salgaonkar * If we have received a synchronous error when in userspace 488b63a0ffeSMahesh Salgaonkar * kill the task. 489b63a0ffeSMahesh Salgaonkar */ 490b63a0ffeSMahesh Salgaonkar _exception(SIGBUS, regs, BUS_MCEERR_AR, regs->nip); 491b63a0ffeSMahesh Salgaonkar recovered = 1; 492b63a0ffeSMahesh Salgaonkar } 493b63a0ffeSMahesh Salgaonkar return recovered; 494b63a0ffeSMahesh Salgaonkar } 495b63a0ffeSMahesh Salgaonkar 496ed79ba9eSBenjamin Herrenschmidt int opal_machine_check(struct pt_regs *regs) 497ed79ba9eSBenjamin Herrenschmidt { 49836df96f8SMahesh Salgaonkar struct machine_check_event evt; 499ed79ba9eSBenjamin Herrenschmidt 50036df96f8SMahesh Salgaonkar if (!get_mce_event(&evt, MCE_EVENT_RELEASE)) 50136df96f8SMahesh Salgaonkar return 0; 502ed79ba9eSBenjamin Herrenschmidt 503ed79ba9eSBenjamin Herrenschmidt /* Print things out */ 50436df96f8SMahesh Salgaonkar if (evt.version != MCE_V1) { 505ed79ba9eSBenjamin Herrenschmidt pr_err("Machine Check Exception, Unknown event version %d !\n", 506ed79ba9eSBenjamin Herrenschmidt evt.version); 507ed79ba9eSBenjamin Herrenschmidt return 0; 508ed79ba9eSBenjamin Herrenschmidt } 509b5ff4211SMahesh Salgaonkar machine_check_print_event_info(&evt); 510ed79ba9eSBenjamin Herrenschmidt 511b63a0ffeSMahesh Salgaonkar if (opal_recover_mce(regs, &evt)) 512b63a0ffeSMahesh Salgaonkar return 1; 513b63a0ffeSMahesh Salgaonkar return 0; 514ed79ba9eSBenjamin Herrenschmidt } 515ed79ba9eSBenjamin Herrenschmidt 51655672ecfSMahesh Salgaonkar static uint64_t find_recovery_address(uint64_t nip) 51755672ecfSMahesh Salgaonkar { 51855672ecfSMahesh Salgaonkar int i; 51955672ecfSMahesh Salgaonkar 52055672ecfSMahesh Salgaonkar for (i = 0; i < mc_recoverable_range_len; i++) 52155672ecfSMahesh Salgaonkar if ((nip >= mc_recoverable_range[i].start_addr) && 52255672ecfSMahesh Salgaonkar (nip < mc_recoverable_range[i].end_addr)) 52355672ecfSMahesh Salgaonkar return mc_recoverable_range[i].recover_addr; 52455672ecfSMahesh Salgaonkar return 0; 52555672ecfSMahesh Salgaonkar } 52655672ecfSMahesh Salgaonkar 52755672ecfSMahesh Salgaonkar bool opal_mce_check_early_recovery(struct pt_regs *regs) 52855672ecfSMahesh Salgaonkar { 52955672ecfSMahesh Salgaonkar uint64_t recover_addr = 0; 53055672ecfSMahesh Salgaonkar 53155672ecfSMahesh Salgaonkar if (!opal.base || !opal.size) 53255672ecfSMahesh Salgaonkar goto out; 53355672ecfSMahesh Salgaonkar 53455672ecfSMahesh Salgaonkar if ((regs->nip >= opal.base) && 53555672ecfSMahesh Salgaonkar (regs->nip <= (opal.base + opal.size))) 53655672ecfSMahesh Salgaonkar recover_addr = find_recovery_address(regs->nip); 53755672ecfSMahesh Salgaonkar 53855672ecfSMahesh Salgaonkar /* 53955672ecfSMahesh Salgaonkar * Setup regs->nip to rfi into fixup address. 54055672ecfSMahesh Salgaonkar */ 54155672ecfSMahesh Salgaonkar if (recover_addr) 54255672ecfSMahesh Salgaonkar regs->nip = recover_addr; 54355672ecfSMahesh Salgaonkar 54455672ecfSMahesh Salgaonkar out: 54555672ecfSMahesh Salgaonkar return !!recover_addr; 54655672ecfSMahesh Salgaonkar } 54755672ecfSMahesh Salgaonkar 548a125e092SBenjamin Herrenschmidt static irqreturn_t opal_interrupt(int irq, void *data) 549a125e092SBenjamin Herrenschmidt { 5505e4da530SAnton Blanchard __be64 events; 551a125e092SBenjamin Herrenschmidt 552a125e092SBenjamin Herrenschmidt opal_handle_interrupt(virq_to_hw(irq), &events); 553a125e092SBenjamin Herrenschmidt 55456b4c993SAnton Blanchard opal_do_notifier(be64_to_cpu(events)); 555a125e092SBenjamin Herrenschmidt 556a125e092SBenjamin Herrenschmidt return IRQ_HANDLED; 557a125e092SBenjamin Herrenschmidt } 558a125e092SBenjamin Herrenschmidt 5596f68b5e2SVasant Hegde static int opal_sysfs_init(void) 5606f68b5e2SVasant Hegde { 5616f68b5e2SVasant Hegde opal_kobj = kobject_create_and_add("opal", firmware_kobj); 5626f68b5e2SVasant Hegde if (!opal_kobj) { 5636f68b5e2SVasant Hegde pr_warn("kobject_create_and_add opal failed\n"); 5646f68b5e2SVasant Hegde return -ENOMEM; 5656f68b5e2SVasant Hegde } 5666f68b5e2SVasant Hegde 5676f68b5e2SVasant Hegde return 0; 5686f68b5e2SVasant Hegde } 5696f68b5e2SVasant Hegde 57014a43e69SBenjamin Herrenschmidt static int __init opal_init(void) 57114a43e69SBenjamin Herrenschmidt { 57214a43e69SBenjamin Herrenschmidt struct device_node *np, *consoles; 5731cc79bc8SAlistair Popple const __be32 *irqs; 574a125e092SBenjamin Herrenschmidt int rc, i, irqlen; 57514a43e69SBenjamin Herrenschmidt 57614a43e69SBenjamin Herrenschmidt opal_node = of_find_node_by_path("/ibm,opal"); 57714a43e69SBenjamin Herrenschmidt if (!opal_node) { 57814a43e69SBenjamin Herrenschmidt pr_warn("opal: Node not found\n"); 57914a43e69SBenjamin Herrenschmidt return -ENODEV; 58014a43e69SBenjamin Herrenschmidt } 5812db29d28SBenjamin Herrenschmidt 5822db29d28SBenjamin Herrenschmidt /* Register OPAL consoles if any ports */ 58314a43e69SBenjamin Herrenschmidt if (firmware_has_feature(FW_FEATURE_OPALv2)) 58414a43e69SBenjamin Herrenschmidt consoles = of_find_node_by_path("/ibm,opal/consoles"); 58514a43e69SBenjamin Herrenschmidt else 58614a43e69SBenjamin Herrenschmidt consoles = of_node_get(opal_node); 5872db29d28SBenjamin Herrenschmidt if (consoles) { 58814a43e69SBenjamin Herrenschmidt for_each_child_of_node(consoles, np) { 58914a43e69SBenjamin Herrenschmidt if (strcmp(np->name, "serial")) 59014a43e69SBenjamin Herrenschmidt continue; 59114a43e69SBenjamin Herrenschmidt of_platform_device_create(np, NULL, NULL); 59214a43e69SBenjamin Herrenschmidt } 59314a43e69SBenjamin Herrenschmidt of_node_put(consoles); 5942db29d28SBenjamin Herrenschmidt } 595a125e092SBenjamin Herrenschmidt 596a125e092SBenjamin Herrenschmidt /* Find all OPAL interrupts and request them */ 597a125e092SBenjamin Herrenschmidt irqs = of_get_property(opal_node, "opal-interrupts", &irqlen); 598a125e092SBenjamin Herrenschmidt pr_debug("opal: Found %d interrupts reserved for OPAL\n", 599a125e092SBenjamin Herrenschmidt irqs ? (irqlen / 4) : 0); 60073ed148aSBenjamin Herrenschmidt opal_irq_count = irqlen / 4; 60173ed148aSBenjamin Herrenschmidt opal_irqs = kzalloc(opal_irq_count * sizeof(unsigned int), GFP_KERNEL); 602a125e092SBenjamin Herrenschmidt for (i = 0; irqs && i < (irqlen / 4); i++, irqs++) { 603a125e092SBenjamin Herrenschmidt unsigned int hwirq = be32_to_cpup(irqs); 604a125e092SBenjamin Herrenschmidt unsigned int irq = irq_create_mapping(NULL, hwirq); 605a125e092SBenjamin Herrenschmidt if (irq == NO_IRQ) { 606a125e092SBenjamin Herrenschmidt pr_warning("opal: Failed to map irq 0x%x\n", hwirq); 607a125e092SBenjamin Herrenschmidt continue; 608a125e092SBenjamin Herrenschmidt } 609a125e092SBenjamin Herrenschmidt rc = request_irq(irq, opal_interrupt, 0, "opal", NULL); 610a125e092SBenjamin Herrenschmidt if (rc) 611a125e092SBenjamin Herrenschmidt pr_warning("opal: Error %d requesting irq %d" 612a125e092SBenjamin Herrenschmidt " (0x%x)\n", rc, irq, hwirq); 61373ed148aSBenjamin Herrenschmidt opal_irqs[i] = irq; 614a125e092SBenjamin Herrenschmidt } 6156f68b5e2SVasant Hegde 6166f68b5e2SVasant Hegde /* Create "opal" kobject under /sys/firmware */ 6176f68b5e2SVasant Hegde rc = opal_sysfs_init(); 61850bd6153SVasant Hegde if (rc == 0) { 619774fea1aSStewart Smith /* Setup error log interface */ 620774fea1aSStewart Smith rc = opal_elog_init(); 62150bd6153SVasant Hegde /* Setup code update interface */ 62250bd6153SVasant Hegde opal_flash_init(); 623c7e64b9cSStewart Smith /* Setup platform dump extract interface */ 624c7e64b9cSStewart Smith opal_platform_dump_init(); 6254029cd66SNeelesh Gupta /* Setup system parameters interface */ 6264029cd66SNeelesh Gupta opal_sys_param_init(); 627bfc36894SJoel Stanley /* Setup message log interface. */ 628bfc36894SJoel Stanley opal_msglog_init(); 62950bd6153SVasant Hegde } 6306f68b5e2SVasant Hegde 63114a43e69SBenjamin Herrenschmidt return 0; 63214a43e69SBenjamin Herrenschmidt } 63314a43e69SBenjamin Herrenschmidt subsys_initcall(opal_init); 63473ed148aSBenjamin Herrenschmidt 63573ed148aSBenjamin Herrenschmidt void opal_shutdown(void) 63673ed148aSBenjamin Herrenschmidt { 63773ed148aSBenjamin Herrenschmidt unsigned int i; 638f7d98d18SVasant Hegde long rc = OPAL_BUSY; 63973ed148aSBenjamin Herrenschmidt 640f7d98d18SVasant Hegde /* First free interrupts, which will also mask them */ 64173ed148aSBenjamin Herrenschmidt for (i = 0; i < opal_irq_count; i++) { 64273ed148aSBenjamin Herrenschmidt if (opal_irqs[i]) 643b0d436c7SAnton Blanchard free_irq(opal_irqs[i], NULL); 64473ed148aSBenjamin Herrenschmidt opal_irqs[i] = 0; 64573ed148aSBenjamin Herrenschmidt } 646f7d98d18SVasant Hegde 647f7d98d18SVasant Hegde /* 648f7d98d18SVasant Hegde * Then sync with OPAL which ensure anything that can 649f7d98d18SVasant Hegde * potentially write to our memory has completed such 650f7d98d18SVasant Hegde * as an ongoing dump retrieval 651f7d98d18SVasant Hegde */ 652f7d98d18SVasant Hegde while (rc == OPAL_BUSY || rc == OPAL_BUSY_EVENT) { 653f7d98d18SVasant Hegde rc = opal_sync_host_reboot(); 654f7d98d18SVasant Hegde if (rc == OPAL_BUSY) 655f7d98d18SVasant Hegde opal_poll_events(NULL); 656f7d98d18SVasant Hegde else 657f7d98d18SVasant Hegde mdelay(10); 658f7d98d18SVasant Hegde } 65973ed148aSBenjamin Herrenschmidt } 660e28b05e7SJoel Stanley 661e28b05e7SJoel Stanley /* Export this so that test modules can use it */ 662e28b05e7SJoel Stanley EXPORT_SYMBOL_GPL(opal_invalid_call); 6633441f04bSAnton Blanchard 6643441f04bSAnton Blanchard /* Convert a region of vmalloc memory to an opal sg list */ 6653441f04bSAnton Blanchard struct opal_sg_list *opal_vmalloc_to_sg_list(void *vmalloc_addr, 6663441f04bSAnton Blanchard unsigned long vmalloc_size) 6673441f04bSAnton Blanchard { 6683441f04bSAnton Blanchard struct opal_sg_list *sg, *first = NULL; 6693441f04bSAnton Blanchard unsigned long i = 0; 6703441f04bSAnton Blanchard 6713441f04bSAnton Blanchard sg = kzalloc(PAGE_SIZE, GFP_KERNEL); 6723441f04bSAnton Blanchard if (!sg) 6733441f04bSAnton Blanchard goto nomem; 6743441f04bSAnton Blanchard 6753441f04bSAnton Blanchard first = sg; 6763441f04bSAnton Blanchard 6773441f04bSAnton Blanchard while (vmalloc_size > 0) { 6783441f04bSAnton Blanchard uint64_t data = vmalloc_to_pfn(vmalloc_addr) << PAGE_SHIFT; 6793441f04bSAnton Blanchard uint64_t length = min(vmalloc_size, PAGE_SIZE); 6803441f04bSAnton Blanchard 6813441f04bSAnton Blanchard sg->entry[i].data = cpu_to_be64(data); 6823441f04bSAnton Blanchard sg->entry[i].length = cpu_to_be64(length); 6833441f04bSAnton Blanchard i++; 6843441f04bSAnton Blanchard 6853441f04bSAnton Blanchard if (i >= SG_ENTRIES_PER_NODE) { 6863441f04bSAnton Blanchard struct opal_sg_list *next; 6873441f04bSAnton Blanchard 6883441f04bSAnton Blanchard next = kzalloc(PAGE_SIZE, GFP_KERNEL); 6893441f04bSAnton Blanchard if (!next) 6903441f04bSAnton Blanchard goto nomem; 6913441f04bSAnton Blanchard 6923441f04bSAnton Blanchard sg->length = cpu_to_be64( 6933441f04bSAnton Blanchard i * sizeof(struct opal_sg_entry) + 16); 6943441f04bSAnton Blanchard i = 0; 6953441f04bSAnton Blanchard sg->next = cpu_to_be64(__pa(next)); 6963441f04bSAnton Blanchard sg = next; 6973441f04bSAnton Blanchard } 6983441f04bSAnton Blanchard 6993441f04bSAnton Blanchard vmalloc_addr += length; 7003441f04bSAnton Blanchard vmalloc_size -= length; 7013441f04bSAnton Blanchard } 7023441f04bSAnton Blanchard 7033441f04bSAnton Blanchard sg->length = cpu_to_be64(i * sizeof(struct opal_sg_entry) + 16); 7043441f04bSAnton Blanchard 7053441f04bSAnton Blanchard return first; 7063441f04bSAnton Blanchard 7073441f04bSAnton Blanchard nomem: 7083441f04bSAnton Blanchard pr_err("%s : Failed to allocate memory\n", __func__); 7093441f04bSAnton Blanchard opal_free_sg_list(first); 7103441f04bSAnton Blanchard return NULL; 7113441f04bSAnton Blanchard } 7123441f04bSAnton Blanchard 7133441f04bSAnton Blanchard void opal_free_sg_list(struct opal_sg_list *sg) 7143441f04bSAnton Blanchard { 7153441f04bSAnton Blanchard while (sg) { 7163441f04bSAnton Blanchard uint64_t next = be64_to_cpu(sg->next); 7173441f04bSAnton Blanchard 7183441f04bSAnton Blanchard kfree(sg); 7193441f04bSAnton Blanchard 7203441f04bSAnton Blanchard if (next) 7213441f04bSAnton Blanchard sg = __va(next); 7223441f04bSAnton Blanchard else 7233441f04bSAnton Blanchard sg = NULL; 7243441f04bSAnton Blanchard } 7253441f04bSAnton Blanchard } 726