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> 25b14726c5SMichael Ellerman 26b14726c5SMichael Ellerman #include <asm/machdep.h> 2714a43e69SBenjamin Herrenschmidt #include <asm/opal.h> 2814a43e69SBenjamin Herrenschmidt #include <asm/firmware.h> 2936df96f8SMahesh Salgaonkar #include <asm/mce.h> 3014a43e69SBenjamin Herrenschmidt 3114a43e69SBenjamin Herrenschmidt #include "powernv.h" 3214a43e69SBenjamin Herrenschmidt 336f68b5e2SVasant Hegde /* /sys/firmware/opal */ 346f68b5e2SVasant Hegde struct kobject *opal_kobj; 356f68b5e2SVasant Hegde 3614a43e69SBenjamin Herrenschmidt struct opal { 3714a43e69SBenjamin Herrenschmidt u64 base; 3814a43e69SBenjamin Herrenschmidt u64 entry; 3955672ecfSMahesh Salgaonkar u64 size; 4014a43e69SBenjamin Herrenschmidt } opal; 4114a43e69SBenjamin Herrenschmidt 4255672ecfSMahesh Salgaonkar struct mcheck_recoverable_range { 4355672ecfSMahesh Salgaonkar u64 start_addr; 4455672ecfSMahesh Salgaonkar u64 end_addr; 4555672ecfSMahesh Salgaonkar u64 recover_addr; 4655672ecfSMahesh Salgaonkar }; 4755672ecfSMahesh Salgaonkar 4855672ecfSMahesh Salgaonkar static struct mcheck_recoverable_range *mc_recoverable_range; 4955672ecfSMahesh Salgaonkar static int mc_recoverable_range_len; 5055672ecfSMahesh Salgaonkar 51bfc36894SJoel Stanley struct device_node *opal_node; 5214a43e69SBenjamin Herrenschmidt static DEFINE_SPINLOCK(opal_write_lock); 53ed79ba9eSBenjamin Herrenschmidt extern u64 opal_mc_secondary_handler[]; 5473ed148aSBenjamin Herrenschmidt static unsigned int *opal_irqs; 5573ed148aSBenjamin Herrenschmidt static unsigned int opal_irq_count; 561bc98de2SGavin Shan static ATOMIC_NOTIFIER_HEAD(opal_notifier_head); 5724366360SMahesh Salgaonkar static struct atomic_notifier_head opal_msg_notifier_head[OPAL_MSG_TYPE_MAX]; 581bc98de2SGavin Shan static DEFINE_SPINLOCK(opal_notifier_lock); 591bc98de2SGavin Shan static uint64_t last_notified_mask = 0x0ul; 601bc98de2SGavin Shan static atomic_t opal_notifier_hold = ATOMIC_INIT(0); 6114a43e69SBenjamin Herrenschmidt 624926616cSBenjamin Herrenschmidt static void opal_reinit_cores(void) 634926616cSBenjamin Herrenschmidt { 644926616cSBenjamin Herrenschmidt /* Do the actual re-init, This will clobber all FPRs, VRs, etc... 654926616cSBenjamin Herrenschmidt * 664926616cSBenjamin Herrenschmidt * It will preserve non volatile GPRs and HSPRG0/1. It will 674926616cSBenjamin Herrenschmidt * also restore HIDs and other SPRs to their original value 684926616cSBenjamin Herrenschmidt * but it might clobber a bunch. 694926616cSBenjamin Herrenschmidt */ 704926616cSBenjamin Herrenschmidt #ifdef __BIG_ENDIAN__ 714926616cSBenjamin Herrenschmidt opal_reinit_cpus(OPAL_REINIT_CPUS_HILE_BE); 724926616cSBenjamin Herrenschmidt #else 734926616cSBenjamin Herrenschmidt opal_reinit_cpus(OPAL_REINIT_CPUS_HILE_LE); 744926616cSBenjamin Herrenschmidt #endif 754926616cSBenjamin Herrenschmidt } 764926616cSBenjamin Herrenschmidt 7714a43e69SBenjamin Herrenschmidt int __init early_init_dt_scan_opal(unsigned long node, 7814a43e69SBenjamin Herrenschmidt const char *uname, int depth, void *data) 7914a43e69SBenjamin Herrenschmidt { 8055672ecfSMahesh Salgaonkar const void *basep, *entryp, *sizep; 819d0c4dfeSRob Herring int basesz, entrysz, runtimesz; 8214a43e69SBenjamin Herrenschmidt 8314a43e69SBenjamin Herrenschmidt if (depth != 1 || strcmp(uname, "ibm,opal") != 0) 8414a43e69SBenjamin Herrenschmidt return 0; 8514a43e69SBenjamin Herrenschmidt 8614a43e69SBenjamin Herrenschmidt basep = of_get_flat_dt_prop(node, "opal-base-address", &basesz); 8714a43e69SBenjamin Herrenschmidt entryp = of_get_flat_dt_prop(node, "opal-entry-address", &entrysz); 8855672ecfSMahesh Salgaonkar sizep = of_get_flat_dt_prop(node, "opal-runtime-size", &runtimesz); 8914a43e69SBenjamin Herrenschmidt 9055672ecfSMahesh Salgaonkar if (!basep || !entryp || !sizep) 9114a43e69SBenjamin Herrenschmidt return 1; 9214a43e69SBenjamin Herrenschmidt 9314a43e69SBenjamin Herrenschmidt opal.base = of_read_number(basep, basesz/4); 9414a43e69SBenjamin Herrenschmidt opal.entry = of_read_number(entryp, entrysz/4); 9555672ecfSMahesh Salgaonkar opal.size = of_read_number(sizep, runtimesz/4); 9614a43e69SBenjamin Herrenschmidt 979d0c4dfeSRob Herring pr_debug("OPAL Base = 0x%llx (basep=%p basesz=%d)\n", 9814a43e69SBenjamin Herrenschmidt opal.base, basep, basesz); 999d0c4dfeSRob Herring pr_debug("OPAL Entry = 0x%llx (entryp=%p basesz=%d)\n", 10014a43e69SBenjamin Herrenschmidt opal.entry, entryp, entrysz); 1019d0c4dfeSRob Herring pr_debug("OPAL Entry = 0x%llx (sizep=%p runtimesz=%d)\n", 10255672ecfSMahesh Salgaonkar opal.size, sizep, runtimesz); 10314a43e69SBenjamin Herrenschmidt 10414a43e69SBenjamin Herrenschmidt powerpc_firmware_features |= FW_FEATURE_OPAL; 10575b93da4SBenjamin Herrenschmidt if (of_flat_dt_is_compatible(node, "ibm,opal-v3")) { 10675b93da4SBenjamin Herrenschmidt powerpc_firmware_features |= FW_FEATURE_OPALv2; 10775b93da4SBenjamin Herrenschmidt powerpc_firmware_features |= FW_FEATURE_OPALv3; 10875b93da4SBenjamin Herrenschmidt printk("OPAL V3 detected !\n"); 10975b93da4SBenjamin Herrenschmidt } else if (of_flat_dt_is_compatible(node, "ibm,opal-v2")) { 11014a43e69SBenjamin Herrenschmidt powerpc_firmware_features |= FW_FEATURE_OPALv2; 11114a43e69SBenjamin Herrenschmidt printk("OPAL V2 detected !\n"); 11214a43e69SBenjamin Herrenschmidt } else { 11314a43e69SBenjamin Herrenschmidt printk("OPAL V1 detected !\n"); 11414a43e69SBenjamin Herrenschmidt } 11514a43e69SBenjamin Herrenschmidt 1164926616cSBenjamin Herrenschmidt /* Reinit all cores with the right endian */ 1174926616cSBenjamin Herrenschmidt opal_reinit_cores(); 1184926616cSBenjamin Herrenschmidt 1194926616cSBenjamin Herrenschmidt /* Restore some bits */ 1204926616cSBenjamin Herrenschmidt if (cur_cpu_spec->cpu_restore) 1214926616cSBenjamin Herrenschmidt cur_cpu_spec->cpu_restore(); 1224926616cSBenjamin Herrenschmidt 123c4463b37SJeremy Kerr return 1; 124c4463b37SJeremy Kerr } 125c4463b37SJeremy Kerr 12655672ecfSMahesh Salgaonkar int __init early_init_dt_scan_recoverable_ranges(unsigned long node, 12755672ecfSMahesh Salgaonkar const char *uname, int depth, void *data) 12855672ecfSMahesh Salgaonkar { 1299d0c4dfeSRob Herring int i, psize, size; 13055672ecfSMahesh Salgaonkar const __be32 *prop; 13155672ecfSMahesh Salgaonkar 13255672ecfSMahesh Salgaonkar if (depth != 1 || strcmp(uname, "ibm,opal") != 0) 13355672ecfSMahesh Salgaonkar return 0; 13455672ecfSMahesh Salgaonkar 1356e556b47SMahesh Salgaonkar prop = of_get_flat_dt_prop(node, "mcheck-recoverable-ranges", &psize); 13655672ecfSMahesh Salgaonkar 13755672ecfSMahesh Salgaonkar if (!prop) 13855672ecfSMahesh Salgaonkar return 1; 13955672ecfSMahesh Salgaonkar 14055672ecfSMahesh Salgaonkar pr_debug("Found machine check recoverable ranges.\n"); 14155672ecfSMahesh Salgaonkar 14255672ecfSMahesh Salgaonkar /* 1436e556b47SMahesh Salgaonkar * Calculate number of available entries. 1446e556b47SMahesh Salgaonkar * 1456e556b47SMahesh Salgaonkar * Each recoverable address range entry is (start address, len, 1466e556b47SMahesh Salgaonkar * recovery address), 2 cells each for start and recovery address, 1476e556b47SMahesh Salgaonkar * 1 cell for len, totalling 5 cells per entry. 1486e556b47SMahesh Salgaonkar */ 1496e556b47SMahesh Salgaonkar mc_recoverable_range_len = psize / (sizeof(*prop) * 5); 1506e556b47SMahesh Salgaonkar 1516e556b47SMahesh Salgaonkar /* Sanity check */ 1526e556b47SMahesh Salgaonkar if (!mc_recoverable_range_len) 1536e556b47SMahesh Salgaonkar return 1; 1546e556b47SMahesh Salgaonkar 1556e556b47SMahesh Salgaonkar /* Size required to hold all the entries. */ 1566e556b47SMahesh Salgaonkar size = mc_recoverable_range_len * 1576e556b47SMahesh Salgaonkar sizeof(struct mcheck_recoverable_range); 1586e556b47SMahesh Salgaonkar 1596e556b47SMahesh Salgaonkar /* 16055672ecfSMahesh Salgaonkar * Allocate a buffer to hold the MC recoverable ranges. We would be 16155672ecfSMahesh Salgaonkar * accessing them in real mode, hence it needs to be within 16255672ecfSMahesh Salgaonkar * RMO region. 16355672ecfSMahesh Salgaonkar */ 16455672ecfSMahesh Salgaonkar mc_recoverable_range =__va(memblock_alloc_base(size, __alignof__(u64), 16555672ecfSMahesh Salgaonkar ppc64_rma_size)); 16655672ecfSMahesh Salgaonkar memset(mc_recoverable_range, 0, size); 16755672ecfSMahesh Salgaonkar 1686e556b47SMahesh Salgaonkar for (i = 0; i < mc_recoverable_range_len; i++) { 16955672ecfSMahesh Salgaonkar mc_recoverable_range[i].start_addr = 17055672ecfSMahesh Salgaonkar of_read_number(prop + (i * 5) + 0, 2); 17155672ecfSMahesh Salgaonkar mc_recoverable_range[i].end_addr = 17255672ecfSMahesh Salgaonkar mc_recoverable_range[i].start_addr + 17355672ecfSMahesh Salgaonkar of_read_number(prop + (i * 5) + 2, 1); 17455672ecfSMahesh Salgaonkar mc_recoverable_range[i].recover_addr = 17555672ecfSMahesh Salgaonkar of_read_number(prop + (i * 5) + 3, 2); 17655672ecfSMahesh Salgaonkar 17755672ecfSMahesh Salgaonkar pr_debug("Machine check recoverable range: %llx..%llx: %llx\n", 17855672ecfSMahesh Salgaonkar mc_recoverable_range[i].start_addr, 17955672ecfSMahesh Salgaonkar mc_recoverable_range[i].end_addr, 18055672ecfSMahesh Salgaonkar mc_recoverable_range[i].recover_addr); 18155672ecfSMahesh Salgaonkar } 18255672ecfSMahesh Salgaonkar return 1; 18355672ecfSMahesh Salgaonkar } 18455672ecfSMahesh Salgaonkar 185c4463b37SJeremy Kerr static int __init opal_register_exception_handlers(void) 186c4463b37SJeremy Kerr { 18729186097SBenjamin Herrenschmidt #ifdef __BIG_ENDIAN__ 188c4463b37SJeremy Kerr u64 glue; 189c4463b37SJeremy Kerr 190c4463b37SJeremy Kerr if (!(powerpc_firmware_features & FW_FEATURE_OPAL)) 191c4463b37SJeremy Kerr return -ENODEV; 192c4463b37SJeremy Kerr 19328446de2SMahesh Salgaonkar /* Hookup some exception handlers except machine check. We use the 19428446de2SMahesh Salgaonkar * fwnmi area at 0x7000 to provide the glue space to OPAL 195ed79ba9eSBenjamin Herrenschmidt */ 196ed79ba9eSBenjamin Herrenschmidt glue = 0x7000; 197ed79ba9eSBenjamin Herrenschmidt opal_register_exception_handler(OPAL_HYPERVISOR_MAINTENANCE_HANDLER, 198ed79ba9eSBenjamin Herrenschmidt 0, glue); 199ed79ba9eSBenjamin Herrenschmidt glue += 128; 200ed79ba9eSBenjamin Herrenschmidt opal_register_exception_handler(OPAL_SOFTPATCH_HANDLER, 0, glue); 20129186097SBenjamin Herrenschmidt #endif 202ed79ba9eSBenjamin Herrenschmidt 203c4463b37SJeremy Kerr return 0; 20414a43e69SBenjamin Herrenschmidt } 205b14726c5SMichael Ellerman machine_early_initcall(powernv, opal_register_exception_handlers); 206c4463b37SJeremy Kerr 2071bc98de2SGavin Shan int opal_notifier_register(struct notifier_block *nb) 2081bc98de2SGavin Shan { 2091bc98de2SGavin Shan if (!nb) { 2101bc98de2SGavin Shan pr_warning("%s: Invalid argument (%p)\n", 2111bc98de2SGavin Shan __func__, nb); 2121bc98de2SGavin Shan return -EINVAL; 2131bc98de2SGavin Shan } 2141bc98de2SGavin Shan 2151bc98de2SGavin Shan atomic_notifier_chain_register(&opal_notifier_head, nb); 2161bc98de2SGavin Shan return 0; 2171bc98de2SGavin Shan } 218798af00cSBenjamin Herrenschmidt EXPORT_SYMBOL_GPL(opal_notifier_register); 219798af00cSBenjamin Herrenschmidt 220798af00cSBenjamin Herrenschmidt int opal_notifier_unregister(struct notifier_block *nb) 221798af00cSBenjamin Herrenschmidt { 222798af00cSBenjamin Herrenschmidt if (!nb) { 223798af00cSBenjamin Herrenschmidt pr_warning("%s: Invalid argument (%p)\n", 224798af00cSBenjamin Herrenschmidt __func__, nb); 225798af00cSBenjamin Herrenschmidt return -EINVAL; 226798af00cSBenjamin Herrenschmidt } 227798af00cSBenjamin Herrenschmidt 228798af00cSBenjamin Herrenschmidt atomic_notifier_chain_unregister(&opal_notifier_head, nb); 229798af00cSBenjamin Herrenschmidt return 0; 230798af00cSBenjamin Herrenschmidt } 231798af00cSBenjamin Herrenschmidt EXPORT_SYMBOL_GPL(opal_notifier_unregister); 2321bc98de2SGavin Shan 2331bc98de2SGavin Shan static void opal_do_notifier(uint64_t events) 2341bc98de2SGavin Shan { 2351bc98de2SGavin Shan unsigned long flags; 2361bc98de2SGavin Shan uint64_t changed_mask; 2371bc98de2SGavin Shan 2381bc98de2SGavin Shan if (atomic_read(&opal_notifier_hold)) 2391bc98de2SGavin Shan return; 2401bc98de2SGavin Shan 2411bc98de2SGavin Shan spin_lock_irqsave(&opal_notifier_lock, flags); 2421bc98de2SGavin Shan changed_mask = last_notified_mask ^ events; 2431bc98de2SGavin Shan last_notified_mask = events; 2441bc98de2SGavin Shan spin_unlock_irqrestore(&opal_notifier_lock, flags); 2451bc98de2SGavin Shan 2461bc98de2SGavin Shan /* 2471bc98de2SGavin Shan * We feed with the event bits and changed bits for 2481bc98de2SGavin Shan * enough information to the callback. 2491bc98de2SGavin Shan */ 2501bc98de2SGavin Shan atomic_notifier_call_chain(&opal_notifier_head, 2511bc98de2SGavin Shan events, (void *)changed_mask); 2521bc98de2SGavin Shan } 2531bc98de2SGavin Shan 2541bc98de2SGavin Shan void opal_notifier_update_evt(uint64_t evt_mask, 2551bc98de2SGavin Shan uint64_t evt_val) 2561bc98de2SGavin Shan { 2571bc98de2SGavin Shan unsigned long flags; 2581bc98de2SGavin Shan 2591bc98de2SGavin Shan spin_lock_irqsave(&opal_notifier_lock, flags); 2601bc98de2SGavin Shan last_notified_mask &= ~evt_mask; 2611bc98de2SGavin Shan last_notified_mask |= evt_val; 2621bc98de2SGavin Shan spin_unlock_irqrestore(&opal_notifier_lock, flags); 2631bc98de2SGavin Shan } 2641bc98de2SGavin Shan 2651bc98de2SGavin Shan void opal_notifier_enable(void) 2661bc98de2SGavin Shan { 2671bc98de2SGavin Shan int64_t rc; 26856b4c993SAnton Blanchard __be64 evt = 0; 2691bc98de2SGavin Shan 2701bc98de2SGavin Shan atomic_set(&opal_notifier_hold, 0); 2711bc98de2SGavin Shan 2721bc98de2SGavin Shan /* Process pending events */ 2731bc98de2SGavin Shan rc = opal_poll_events(&evt); 2741bc98de2SGavin Shan if (rc == OPAL_SUCCESS && evt) 27556b4c993SAnton Blanchard opal_do_notifier(be64_to_cpu(evt)); 2761bc98de2SGavin Shan } 2771bc98de2SGavin Shan 2781bc98de2SGavin Shan void opal_notifier_disable(void) 2791bc98de2SGavin Shan { 2801bc98de2SGavin Shan atomic_set(&opal_notifier_hold, 1); 2811bc98de2SGavin Shan } 2821bc98de2SGavin Shan 28324366360SMahesh Salgaonkar /* 28424366360SMahesh Salgaonkar * Opal message notifier based on message type. Allow subscribers to get 28524366360SMahesh Salgaonkar * notified for specific messgae type. 28624366360SMahesh Salgaonkar */ 28724366360SMahesh Salgaonkar int opal_message_notifier_register(enum OpalMessageType msg_type, 28824366360SMahesh Salgaonkar struct notifier_block *nb) 28924366360SMahesh Salgaonkar { 29024366360SMahesh Salgaonkar if (!nb) { 29124366360SMahesh Salgaonkar pr_warning("%s: Invalid argument (%p)\n", 29224366360SMahesh Salgaonkar __func__, nb); 29324366360SMahesh Salgaonkar return -EINVAL; 29424366360SMahesh Salgaonkar } 29524366360SMahesh Salgaonkar if (msg_type > OPAL_MSG_TYPE_MAX) { 29624366360SMahesh Salgaonkar pr_warning("%s: Invalid message type argument (%d)\n", 29724366360SMahesh Salgaonkar __func__, msg_type); 29824366360SMahesh Salgaonkar return -EINVAL; 29924366360SMahesh Salgaonkar } 30024366360SMahesh Salgaonkar return atomic_notifier_chain_register( 30124366360SMahesh Salgaonkar &opal_msg_notifier_head[msg_type], nb); 30224366360SMahesh Salgaonkar } 30324366360SMahesh Salgaonkar 30424366360SMahesh Salgaonkar static void opal_message_do_notify(uint32_t msg_type, void *msg) 30524366360SMahesh Salgaonkar { 30624366360SMahesh Salgaonkar /* notify subscribers */ 30724366360SMahesh Salgaonkar atomic_notifier_call_chain(&opal_msg_notifier_head[msg_type], 30824366360SMahesh Salgaonkar msg_type, msg); 30924366360SMahesh Salgaonkar } 31024366360SMahesh Salgaonkar 31124366360SMahesh Salgaonkar static void opal_handle_message(void) 31224366360SMahesh Salgaonkar { 31324366360SMahesh Salgaonkar s64 ret; 31424366360SMahesh Salgaonkar /* 31524366360SMahesh Salgaonkar * TODO: pre-allocate a message buffer depending on opal-msg-size 31624366360SMahesh Salgaonkar * value in /proc/device-tree. 31724366360SMahesh Salgaonkar */ 31824366360SMahesh Salgaonkar static struct opal_msg msg; 319bb4398e1SAnton Blanchard u32 type; 32024366360SMahesh Salgaonkar 32124366360SMahesh Salgaonkar ret = opal_get_msg(__pa(&msg), sizeof(msg)); 32224366360SMahesh Salgaonkar /* No opal message pending. */ 32324366360SMahesh Salgaonkar if (ret == OPAL_RESOURCE) 32424366360SMahesh Salgaonkar return; 32524366360SMahesh Salgaonkar 32624366360SMahesh Salgaonkar /* check for errors. */ 32724366360SMahesh Salgaonkar if (ret) { 32824366360SMahesh Salgaonkar pr_warning("%s: Failed to retrive opal message, err=%lld\n", 32924366360SMahesh Salgaonkar __func__, ret); 33024366360SMahesh Salgaonkar return; 33124366360SMahesh Salgaonkar } 33224366360SMahesh Salgaonkar 333bb4398e1SAnton Blanchard type = be32_to_cpu(msg.msg_type); 334bb4398e1SAnton Blanchard 33524366360SMahesh Salgaonkar /* Sanity check */ 336bb4398e1SAnton Blanchard if (type > OPAL_MSG_TYPE_MAX) { 337bb4398e1SAnton Blanchard pr_warning("%s: Unknown message type: %u\n", __func__, type); 33824366360SMahesh Salgaonkar return; 33924366360SMahesh Salgaonkar } 340bb4398e1SAnton Blanchard opal_message_do_notify(type, (void *)&msg); 34124366360SMahesh Salgaonkar } 34224366360SMahesh Salgaonkar 34324366360SMahesh Salgaonkar static int opal_message_notify(struct notifier_block *nb, 34424366360SMahesh Salgaonkar unsigned long events, void *change) 34524366360SMahesh Salgaonkar { 34624366360SMahesh Salgaonkar if (events & OPAL_EVENT_MSG_PENDING) 34724366360SMahesh Salgaonkar opal_handle_message(); 34824366360SMahesh Salgaonkar return 0; 34924366360SMahesh Salgaonkar } 35024366360SMahesh Salgaonkar 35124366360SMahesh Salgaonkar static struct notifier_block opal_message_nb = { 35224366360SMahesh Salgaonkar .notifier_call = opal_message_notify, 35324366360SMahesh Salgaonkar .next = NULL, 35424366360SMahesh Salgaonkar .priority = 0, 35524366360SMahesh Salgaonkar }; 35624366360SMahesh Salgaonkar 35724366360SMahesh Salgaonkar static int __init opal_message_init(void) 35824366360SMahesh Salgaonkar { 35924366360SMahesh Salgaonkar int ret, i; 36024366360SMahesh Salgaonkar 36124366360SMahesh Salgaonkar for (i = 0; i < OPAL_MSG_TYPE_MAX; i++) 36224366360SMahesh Salgaonkar ATOMIC_INIT_NOTIFIER_HEAD(&opal_msg_notifier_head[i]); 36324366360SMahesh Salgaonkar 36424366360SMahesh Salgaonkar ret = opal_notifier_register(&opal_message_nb); 36524366360SMahesh Salgaonkar if (ret) { 36624366360SMahesh Salgaonkar pr_err("%s: Can't register OPAL event notifier (%d)\n", 36724366360SMahesh Salgaonkar __func__, ret); 36824366360SMahesh Salgaonkar return ret; 36924366360SMahesh Salgaonkar } 37024366360SMahesh Salgaonkar return 0; 37124366360SMahesh Salgaonkar } 372b14726c5SMichael Ellerman machine_early_initcall(powernv, opal_message_init); 37324366360SMahesh Salgaonkar 37414a43e69SBenjamin Herrenschmidt int opal_get_chars(uint32_t vtermno, char *buf, int count) 37514a43e69SBenjamin Herrenschmidt { 3764f89363bSBenjamin Herrenschmidt s64 rc; 3774f89363bSBenjamin Herrenschmidt __be64 evt, len; 37814a43e69SBenjamin Herrenschmidt 37914a43e69SBenjamin Herrenschmidt if (!opal.entry) 380daea1175SBenjamin Herrenschmidt return -ENODEV; 38114a43e69SBenjamin Herrenschmidt opal_poll_events(&evt); 3824f89363bSBenjamin Herrenschmidt if ((be64_to_cpu(evt) & OPAL_EVENT_CONSOLE_INPUT) == 0) 38314a43e69SBenjamin Herrenschmidt return 0; 3844f89363bSBenjamin Herrenschmidt len = cpu_to_be64(count); 38514a43e69SBenjamin Herrenschmidt rc = opal_console_read(vtermno, &len, buf); 38614a43e69SBenjamin Herrenschmidt if (rc == OPAL_SUCCESS) 3874f89363bSBenjamin Herrenschmidt return be64_to_cpu(len); 38814a43e69SBenjamin Herrenschmidt return 0; 38914a43e69SBenjamin Herrenschmidt } 39014a43e69SBenjamin Herrenschmidt 39114a43e69SBenjamin Herrenschmidt int opal_put_chars(uint32_t vtermno, const char *data, int total_len) 39214a43e69SBenjamin Herrenschmidt { 39314a43e69SBenjamin Herrenschmidt int written = 0; 3944f89363bSBenjamin Herrenschmidt __be64 olen; 395daea1175SBenjamin Herrenschmidt s64 len, rc; 39614a43e69SBenjamin Herrenschmidt unsigned long flags; 3974f89363bSBenjamin Herrenschmidt __be64 evt; 39814a43e69SBenjamin Herrenschmidt 39914a43e69SBenjamin Herrenschmidt if (!opal.entry) 400daea1175SBenjamin Herrenschmidt return -ENODEV; 40114a43e69SBenjamin Herrenschmidt 40214a43e69SBenjamin Herrenschmidt /* We want put_chars to be atomic to avoid mangling of hvsi 40314a43e69SBenjamin Herrenschmidt * packets. To do that, we first test for room and return 404daea1175SBenjamin Herrenschmidt * -EAGAIN if there isn't enough. 405daea1175SBenjamin Herrenschmidt * 406daea1175SBenjamin Herrenschmidt * Unfortunately, opal_console_write_buffer_space() doesn't 407daea1175SBenjamin Herrenschmidt * appear to work on opal v1, so we just assume there is 408daea1175SBenjamin Herrenschmidt * enough room and be done with it 40914a43e69SBenjamin Herrenschmidt */ 41014a43e69SBenjamin Herrenschmidt spin_lock_irqsave(&opal_write_lock, flags); 411daea1175SBenjamin Herrenschmidt if (firmware_has_feature(FW_FEATURE_OPALv2)) { 4124f89363bSBenjamin Herrenschmidt rc = opal_console_write_buffer_space(vtermno, &olen); 4134f89363bSBenjamin Herrenschmidt len = be64_to_cpu(olen); 41414a43e69SBenjamin Herrenschmidt if (rc || len < total_len) { 41514a43e69SBenjamin Herrenschmidt spin_unlock_irqrestore(&opal_write_lock, flags); 41614a43e69SBenjamin Herrenschmidt /* Closed -> drop characters */ 41714a43e69SBenjamin Herrenschmidt if (rc) 41814a43e69SBenjamin Herrenschmidt return total_len; 4194f89363bSBenjamin Herrenschmidt opal_poll_events(NULL); 42014a43e69SBenjamin Herrenschmidt return -EAGAIN; 42114a43e69SBenjamin Herrenschmidt } 422daea1175SBenjamin Herrenschmidt } 42314a43e69SBenjamin Herrenschmidt 42414a43e69SBenjamin Herrenschmidt /* We still try to handle partial completions, though they 42514a43e69SBenjamin Herrenschmidt * should no longer happen. 42614a43e69SBenjamin Herrenschmidt */ 427daea1175SBenjamin Herrenschmidt rc = OPAL_BUSY; 42814a43e69SBenjamin Herrenschmidt while(total_len > 0 && (rc == OPAL_BUSY || 42914a43e69SBenjamin Herrenschmidt rc == OPAL_BUSY_EVENT || rc == OPAL_SUCCESS)) { 4304f89363bSBenjamin Herrenschmidt olen = cpu_to_be64(total_len); 4314f89363bSBenjamin Herrenschmidt rc = opal_console_write(vtermno, &olen, data); 4324f89363bSBenjamin Herrenschmidt len = be64_to_cpu(olen); 4331de1455fSBenjamin Herrenschmidt 4341de1455fSBenjamin Herrenschmidt /* Closed or other error drop */ 4351de1455fSBenjamin Herrenschmidt if (rc != OPAL_SUCCESS && rc != OPAL_BUSY && 4361de1455fSBenjamin Herrenschmidt rc != OPAL_BUSY_EVENT) { 4371de1455fSBenjamin Herrenschmidt written = total_len; 4381de1455fSBenjamin Herrenschmidt break; 4391de1455fSBenjamin Herrenschmidt } 44014a43e69SBenjamin Herrenschmidt if (rc == OPAL_SUCCESS) { 44114a43e69SBenjamin Herrenschmidt total_len -= len; 44214a43e69SBenjamin Herrenschmidt data += len; 44314a43e69SBenjamin Herrenschmidt written += len; 44414a43e69SBenjamin Herrenschmidt } 44514a43e69SBenjamin Herrenschmidt /* This is a bit nasty but we need that for the console to 44614a43e69SBenjamin Herrenschmidt * flush when there aren't any interrupts. We will clean 44714a43e69SBenjamin Herrenschmidt * things a bit later to limit that to synchronous path 44814a43e69SBenjamin Herrenschmidt * such as the kernel console and xmon/udbg 44914a43e69SBenjamin Herrenschmidt */ 45014a43e69SBenjamin Herrenschmidt do 45114a43e69SBenjamin Herrenschmidt opal_poll_events(&evt); 4524f89363bSBenjamin Herrenschmidt while(rc == OPAL_SUCCESS && 4534f89363bSBenjamin Herrenschmidt (be64_to_cpu(evt) & OPAL_EVENT_CONSOLE_OUTPUT)); 45414a43e69SBenjamin Herrenschmidt } 45514a43e69SBenjamin Herrenschmidt spin_unlock_irqrestore(&opal_write_lock, flags); 45614a43e69SBenjamin Herrenschmidt return written; 45714a43e69SBenjamin Herrenschmidt } 45814a43e69SBenjamin Herrenschmidt 459b63a0ffeSMahesh Salgaonkar static int opal_recover_mce(struct pt_regs *regs, 460b63a0ffeSMahesh Salgaonkar struct machine_check_event *evt) 461b63a0ffeSMahesh Salgaonkar { 462b63a0ffeSMahesh Salgaonkar int recovered = 0; 463b63a0ffeSMahesh Salgaonkar uint64_t ea = get_mce_fault_addr(evt); 464b63a0ffeSMahesh Salgaonkar 465b63a0ffeSMahesh Salgaonkar if (!(regs->msr & MSR_RI)) { 466b63a0ffeSMahesh Salgaonkar /* If MSR_RI isn't set, we cannot recover */ 467b63a0ffeSMahesh Salgaonkar recovered = 0; 468b63a0ffeSMahesh Salgaonkar } else if (evt->disposition == MCE_DISPOSITION_RECOVERED) { 469b63a0ffeSMahesh Salgaonkar /* Platform corrected itself */ 470b63a0ffeSMahesh Salgaonkar recovered = 1; 471b63a0ffeSMahesh Salgaonkar } else if (ea && !is_kernel_addr(ea)) { 472b63a0ffeSMahesh Salgaonkar /* 473b63a0ffeSMahesh Salgaonkar * Faulting address is not in kernel text. We should be fine. 474b63a0ffeSMahesh Salgaonkar * We need to find which process uses this address. 475b63a0ffeSMahesh Salgaonkar * For now, kill the task if we have received exception when 476b63a0ffeSMahesh Salgaonkar * in userspace. 477b63a0ffeSMahesh Salgaonkar * 478b63a0ffeSMahesh Salgaonkar * TODO: Queue up this address for hwpoisioning later. 479b63a0ffeSMahesh Salgaonkar */ 480b63a0ffeSMahesh Salgaonkar if (user_mode(regs) && !is_global_init(current)) { 481b63a0ffeSMahesh Salgaonkar _exception(SIGBUS, regs, BUS_MCEERR_AR, regs->nip); 482b63a0ffeSMahesh Salgaonkar recovered = 1; 483b63a0ffeSMahesh Salgaonkar } else 484b63a0ffeSMahesh Salgaonkar recovered = 0; 485b63a0ffeSMahesh Salgaonkar } else if (user_mode(regs) && !is_global_init(current) && 486b63a0ffeSMahesh Salgaonkar evt->severity == MCE_SEV_ERROR_SYNC) { 487b63a0ffeSMahesh Salgaonkar /* 488b63a0ffeSMahesh Salgaonkar * If we have received a synchronous error when in userspace 489b63a0ffeSMahesh Salgaonkar * kill the task. 490b63a0ffeSMahesh Salgaonkar */ 491b63a0ffeSMahesh Salgaonkar _exception(SIGBUS, regs, BUS_MCEERR_AR, regs->nip); 492b63a0ffeSMahesh Salgaonkar recovered = 1; 493b63a0ffeSMahesh Salgaonkar } 494b63a0ffeSMahesh Salgaonkar return recovered; 495b63a0ffeSMahesh Salgaonkar } 496b63a0ffeSMahesh Salgaonkar 497ed79ba9eSBenjamin Herrenschmidt int opal_machine_check(struct pt_regs *regs) 498ed79ba9eSBenjamin Herrenschmidt { 49936df96f8SMahesh Salgaonkar struct machine_check_event evt; 500ed79ba9eSBenjamin Herrenschmidt 50136df96f8SMahesh Salgaonkar if (!get_mce_event(&evt, MCE_EVENT_RELEASE)) 50236df96f8SMahesh Salgaonkar return 0; 503ed79ba9eSBenjamin Herrenschmidt 504ed79ba9eSBenjamin Herrenschmidt /* Print things out */ 50536df96f8SMahesh Salgaonkar if (evt.version != MCE_V1) { 506ed79ba9eSBenjamin Herrenschmidt pr_err("Machine Check Exception, Unknown event version %d !\n", 507ed79ba9eSBenjamin Herrenschmidt evt.version); 508ed79ba9eSBenjamin Herrenschmidt return 0; 509ed79ba9eSBenjamin Herrenschmidt } 510b5ff4211SMahesh Salgaonkar machine_check_print_event_info(&evt); 511ed79ba9eSBenjamin Herrenschmidt 512b63a0ffeSMahesh Salgaonkar if (opal_recover_mce(regs, &evt)) 513b63a0ffeSMahesh Salgaonkar return 1; 514b63a0ffeSMahesh Salgaonkar return 0; 515ed79ba9eSBenjamin Herrenschmidt } 516ed79ba9eSBenjamin Herrenschmidt 5170869b6fdSMahesh Salgaonkar /* Early hmi handler called in real mode. */ 5180869b6fdSMahesh Salgaonkar int opal_hmi_exception_early(struct pt_regs *regs) 5190869b6fdSMahesh Salgaonkar { 5200869b6fdSMahesh Salgaonkar /* TODO: Call opal hmi handler. */ 5210869b6fdSMahesh Salgaonkar return 0; 5220869b6fdSMahesh Salgaonkar } 5230869b6fdSMahesh Salgaonkar 5240869b6fdSMahesh Salgaonkar /* HMI exception handler called in virtual mode during check_irq_replay. */ 5250869b6fdSMahesh Salgaonkar int opal_handle_hmi_exception(struct pt_regs *regs) 5260869b6fdSMahesh Salgaonkar { 5270869b6fdSMahesh Salgaonkar /* TODO: Retrive and print HMI event from OPAL. */ 5280869b6fdSMahesh Salgaonkar return 0; 5290869b6fdSMahesh Salgaonkar } 5300869b6fdSMahesh Salgaonkar 53155672ecfSMahesh Salgaonkar static uint64_t find_recovery_address(uint64_t nip) 53255672ecfSMahesh Salgaonkar { 53355672ecfSMahesh Salgaonkar int i; 53455672ecfSMahesh Salgaonkar 53555672ecfSMahesh Salgaonkar for (i = 0; i < mc_recoverable_range_len; i++) 53655672ecfSMahesh Salgaonkar if ((nip >= mc_recoverable_range[i].start_addr) && 53755672ecfSMahesh Salgaonkar (nip < mc_recoverable_range[i].end_addr)) 53855672ecfSMahesh Salgaonkar return mc_recoverable_range[i].recover_addr; 53955672ecfSMahesh Salgaonkar return 0; 54055672ecfSMahesh Salgaonkar } 54155672ecfSMahesh Salgaonkar 54255672ecfSMahesh Salgaonkar bool opal_mce_check_early_recovery(struct pt_regs *regs) 54355672ecfSMahesh Salgaonkar { 54455672ecfSMahesh Salgaonkar uint64_t recover_addr = 0; 54555672ecfSMahesh Salgaonkar 54655672ecfSMahesh Salgaonkar if (!opal.base || !opal.size) 54755672ecfSMahesh Salgaonkar goto out; 54855672ecfSMahesh Salgaonkar 54955672ecfSMahesh Salgaonkar if ((regs->nip >= opal.base) && 55055672ecfSMahesh Salgaonkar (regs->nip <= (opal.base + opal.size))) 55155672ecfSMahesh Salgaonkar recover_addr = find_recovery_address(regs->nip); 55255672ecfSMahesh Salgaonkar 55355672ecfSMahesh Salgaonkar /* 55455672ecfSMahesh Salgaonkar * Setup regs->nip to rfi into fixup address. 55555672ecfSMahesh Salgaonkar */ 55655672ecfSMahesh Salgaonkar if (recover_addr) 55755672ecfSMahesh Salgaonkar regs->nip = recover_addr; 55855672ecfSMahesh Salgaonkar 55955672ecfSMahesh Salgaonkar out: 56055672ecfSMahesh Salgaonkar return !!recover_addr; 56155672ecfSMahesh Salgaonkar } 56255672ecfSMahesh Salgaonkar 563a125e092SBenjamin Herrenschmidt static irqreturn_t opal_interrupt(int irq, void *data) 564a125e092SBenjamin Herrenschmidt { 5655e4da530SAnton Blanchard __be64 events; 566a125e092SBenjamin Herrenschmidt 567a125e092SBenjamin Herrenschmidt opal_handle_interrupt(virq_to_hw(irq), &events); 568a125e092SBenjamin Herrenschmidt 56956b4c993SAnton Blanchard opal_do_notifier(be64_to_cpu(events)); 570a125e092SBenjamin Herrenschmidt 571a125e092SBenjamin Herrenschmidt return IRQ_HANDLED; 572a125e092SBenjamin Herrenschmidt } 573a125e092SBenjamin Herrenschmidt 5746f68b5e2SVasant Hegde static int opal_sysfs_init(void) 5756f68b5e2SVasant Hegde { 5766f68b5e2SVasant Hegde opal_kobj = kobject_create_and_add("opal", firmware_kobj); 5776f68b5e2SVasant Hegde if (!opal_kobj) { 5786f68b5e2SVasant Hegde pr_warn("kobject_create_and_add opal failed\n"); 5796f68b5e2SVasant Hegde return -ENOMEM; 5806f68b5e2SVasant Hegde } 5816f68b5e2SVasant Hegde 5826f68b5e2SVasant Hegde return 0; 5836f68b5e2SVasant Hegde } 5846f68b5e2SVasant Hegde 58514a43e69SBenjamin Herrenschmidt static int __init opal_init(void) 58614a43e69SBenjamin Herrenschmidt { 58714a43e69SBenjamin Herrenschmidt struct device_node *np, *consoles; 5881cc79bc8SAlistair Popple const __be32 *irqs; 589a125e092SBenjamin Herrenschmidt int rc, i, irqlen; 59014a43e69SBenjamin Herrenschmidt 59114a43e69SBenjamin Herrenschmidt opal_node = of_find_node_by_path("/ibm,opal"); 59214a43e69SBenjamin Herrenschmidt if (!opal_node) { 59314a43e69SBenjamin Herrenschmidt pr_warn("opal: Node not found\n"); 59414a43e69SBenjamin Herrenschmidt return -ENODEV; 59514a43e69SBenjamin Herrenschmidt } 5962db29d28SBenjamin Herrenschmidt 5972db29d28SBenjamin Herrenschmidt /* Register OPAL consoles if any ports */ 59814a43e69SBenjamin Herrenschmidt if (firmware_has_feature(FW_FEATURE_OPALv2)) 59914a43e69SBenjamin Herrenschmidt consoles = of_find_node_by_path("/ibm,opal/consoles"); 60014a43e69SBenjamin Herrenschmidt else 60114a43e69SBenjamin Herrenschmidt consoles = of_node_get(opal_node); 6022db29d28SBenjamin Herrenschmidt if (consoles) { 60314a43e69SBenjamin Herrenschmidt for_each_child_of_node(consoles, np) { 60414a43e69SBenjamin Herrenschmidt if (strcmp(np->name, "serial")) 60514a43e69SBenjamin Herrenschmidt continue; 60614a43e69SBenjamin Herrenschmidt of_platform_device_create(np, NULL, NULL); 60714a43e69SBenjamin Herrenschmidt } 60814a43e69SBenjamin Herrenschmidt of_node_put(consoles); 6092db29d28SBenjamin Herrenschmidt } 610a125e092SBenjamin Herrenschmidt 611a125e092SBenjamin Herrenschmidt /* Find all OPAL interrupts and request them */ 612a125e092SBenjamin Herrenschmidt irqs = of_get_property(opal_node, "opal-interrupts", &irqlen); 613a125e092SBenjamin Herrenschmidt pr_debug("opal: Found %d interrupts reserved for OPAL\n", 614a125e092SBenjamin Herrenschmidt irqs ? (irqlen / 4) : 0); 61573ed148aSBenjamin Herrenschmidt opal_irq_count = irqlen / 4; 61673ed148aSBenjamin Herrenschmidt opal_irqs = kzalloc(opal_irq_count * sizeof(unsigned int), GFP_KERNEL); 617a125e092SBenjamin Herrenschmidt for (i = 0; irqs && i < (irqlen / 4); i++, irqs++) { 618a125e092SBenjamin Herrenschmidt unsigned int hwirq = be32_to_cpup(irqs); 619a125e092SBenjamin Herrenschmidt unsigned int irq = irq_create_mapping(NULL, hwirq); 620a125e092SBenjamin Herrenschmidt if (irq == NO_IRQ) { 621a125e092SBenjamin Herrenschmidt pr_warning("opal: Failed to map irq 0x%x\n", hwirq); 622a125e092SBenjamin Herrenschmidt continue; 623a125e092SBenjamin Herrenschmidt } 624a125e092SBenjamin Herrenschmidt rc = request_irq(irq, opal_interrupt, 0, "opal", NULL); 625a125e092SBenjamin Herrenschmidt if (rc) 626a125e092SBenjamin Herrenschmidt pr_warning("opal: Error %d requesting irq %d" 627a125e092SBenjamin Herrenschmidt " (0x%x)\n", rc, irq, hwirq); 62873ed148aSBenjamin Herrenschmidt opal_irqs[i] = irq; 629a125e092SBenjamin Herrenschmidt } 6306f68b5e2SVasant Hegde 6316f68b5e2SVasant Hegde /* Create "opal" kobject under /sys/firmware */ 6326f68b5e2SVasant Hegde rc = opal_sysfs_init(); 63350bd6153SVasant Hegde if (rc == 0) { 634774fea1aSStewart Smith /* Setup error log interface */ 635774fea1aSStewart Smith rc = opal_elog_init(); 63650bd6153SVasant Hegde /* Setup code update interface */ 63750bd6153SVasant Hegde opal_flash_init(); 638c7e64b9cSStewart Smith /* Setup platform dump extract interface */ 639c7e64b9cSStewart Smith opal_platform_dump_init(); 6404029cd66SNeelesh Gupta /* Setup system parameters interface */ 6414029cd66SNeelesh Gupta opal_sys_param_init(); 642bfc36894SJoel Stanley /* Setup message log interface. */ 643bfc36894SJoel Stanley opal_msglog_init(); 64450bd6153SVasant Hegde } 6456f68b5e2SVasant Hegde 64614a43e69SBenjamin Herrenschmidt return 0; 64714a43e69SBenjamin Herrenschmidt } 648b14726c5SMichael Ellerman machine_subsys_initcall(powernv, opal_init); 64973ed148aSBenjamin Herrenschmidt 65073ed148aSBenjamin Herrenschmidt void opal_shutdown(void) 65173ed148aSBenjamin Herrenschmidt { 65273ed148aSBenjamin Herrenschmidt unsigned int i; 653f7d98d18SVasant Hegde long rc = OPAL_BUSY; 65473ed148aSBenjamin Herrenschmidt 655f7d98d18SVasant Hegde /* First free interrupts, which will also mask them */ 65673ed148aSBenjamin Herrenschmidt for (i = 0; i < opal_irq_count; i++) { 65773ed148aSBenjamin Herrenschmidt if (opal_irqs[i]) 658b0d436c7SAnton Blanchard free_irq(opal_irqs[i], NULL); 65973ed148aSBenjamin Herrenschmidt opal_irqs[i] = 0; 66073ed148aSBenjamin Herrenschmidt } 661f7d98d18SVasant Hegde 662f7d98d18SVasant Hegde /* 663f7d98d18SVasant Hegde * Then sync with OPAL which ensure anything that can 664f7d98d18SVasant Hegde * potentially write to our memory has completed such 665f7d98d18SVasant Hegde * as an ongoing dump retrieval 666f7d98d18SVasant Hegde */ 667f7d98d18SVasant Hegde while (rc == OPAL_BUSY || rc == OPAL_BUSY_EVENT) { 668f7d98d18SVasant Hegde rc = opal_sync_host_reboot(); 669f7d98d18SVasant Hegde if (rc == OPAL_BUSY) 670f7d98d18SVasant Hegde opal_poll_events(NULL); 671f7d98d18SVasant Hegde else 672f7d98d18SVasant Hegde mdelay(10); 673f7d98d18SVasant Hegde } 67473ed148aSBenjamin Herrenschmidt } 675e28b05e7SJoel Stanley 676e28b05e7SJoel Stanley /* Export this so that test modules can use it */ 677e28b05e7SJoel Stanley EXPORT_SYMBOL_GPL(opal_invalid_call); 6783441f04bSAnton Blanchard 6793441f04bSAnton Blanchard /* Convert a region of vmalloc memory to an opal sg list */ 6803441f04bSAnton Blanchard struct opal_sg_list *opal_vmalloc_to_sg_list(void *vmalloc_addr, 6813441f04bSAnton Blanchard unsigned long vmalloc_size) 6823441f04bSAnton Blanchard { 6833441f04bSAnton Blanchard struct opal_sg_list *sg, *first = NULL; 6843441f04bSAnton Blanchard unsigned long i = 0; 6853441f04bSAnton Blanchard 6863441f04bSAnton Blanchard sg = kzalloc(PAGE_SIZE, GFP_KERNEL); 6873441f04bSAnton Blanchard if (!sg) 6883441f04bSAnton Blanchard goto nomem; 6893441f04bSAnton Blanchard 6903441f04bSAnton Blanchard first = sg; 6913441f04bSAnton Blanchard 6923441f04bSAnton Blanchard while (vmalloc_size > 0) { 6933441f04bSAnton Blanchard uint64_t data = vmalloc_to_pfn(vmalloc_addr) << PAGE_SHIFT; 6943441f04bSAnton Blanchard uint64_t length = min(vmalloc_size, PAGE_SIZE); 6953441f04bSAnton Blanchard 6963441f04bSAnton Blanchard sg->entry[i].data = cpu_to_be64(data); 6973441f04bSAnton Blanchard sg->entry[i].length = cpu_to_be64(length); 6983441f04bSAnton Blanchard i++; 6993441f04bSAnton Blanchard 7003441f04bSAnton Blanchard if (i >= SG_ENTRIES_PER_NODE) { 7013441f04bSAnton Blanchard struct opal_sg_list *next; 7023441f04bSAnton Blanchard 7033441f04bSAnton Blanchard next = kzalloc(PAGE_SIZE, GFP_KERNEL); 7043441f04bSAnton Blanchard if (!next) 7053441f04bSAnton Blanchard goto nomem; 7063441f04bSAnton Blanchard 7073441f04bSAnton Blanchard sg->length = cpu_to_be64( 7083441f04bSAnton Blanchard i * sizeof(struct opal_sg_entry) + 16); 7093441f04bSAnton Blanchard i = 0; 7103441f04bSAnton Blanchard sg->next = cpu_to_be64(__pa(next)); 7113441f04bSAnton Blanchard sg = next; 7123441f04bSAnton Blanchard } 7133441f04bSAnton Blanchard 7143441f04bSAnton Blanchard vmalloc_addr += length; 7153441f04bSAnton Blanchard vmalloc_size -= length; 7163441f04bSAnton Blanchard } 7173441f04bSAnton Blanchard 7183441f04bSAnton Blanchard sg->length = cpu_to_be64(i * sizeof(struct opal_sg_entry) + 16); 7193441f04bSAnton Blanchard 7203441f04bSAnton Blanchard return first; 7213441f04bSAnton Blanchard 7223441f04bSAnton Blanchard nomem: 7233441f04bSAnton Blanchard pr_err("%s : Failed to allocate memory\n", __func__); 7243441f04bSAnton Blanchard opal_free_sg_list(first); 7253441f04bSAnton Blanchard return NULL; 7263441f04bSAnton Blanchard } 7273441f04bSAnton Blanchard 7283441f04bSAnton Blanchard void opal_free_sg_list(struct opal_sg_list *sg) 7293441f04bSAnton Blanchard { 7303441f04bSAnton Blanchard while (sg) { 7313441f04bSAnton Blanchard uint64_t next = be64_to_cpu(sg->next); 7323441f04bSAnton Blanchard 7333441f04bSAnton Blanchard kfree(sg); 7343441f04bSAnton Blanchard 7353441f04bSAnton Blanchard if (next) 7363441f04bSAnton Blanchard sg = __va(next); 7373441f04bSAnton Blanchard else 7383441f04bSAnton Blanchard sg = NULL; 7393441f04bSAnton Blanchard } 7403441f04bSAnton Blanchard } 741