Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 1 | /* |
| 2 | * PowerNV OPAL high level interfaces |
| 3 | * |
| 4 | * Copyright 2011 IBM Corp. |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or |
| 7 | * modify it under the terms of the GNU General Public License |
| 8 | * as published by the Free Software Foundation; either version |
| 9 | * 2 of the License, or (at your option) any later version. |
| 10 | */ |
| 11 | |
Benjamin Herrenschmidt | c8742f8 | 2014-12-11 12:39:49 +1100 | [diff] [blame] | 12 | #define pr_fmt(fmt) "opal: " fmt |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 13 | |
Benjamin Herrenschmidt | c8742f8 | 2014-12-11 12:39:49 +1100 | [diff] [blame] | 14 | #include <linux/printk.h> |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 15 | #include <linux/types.h> |
| 16 | #include <linux/of.h> |
Rob Herring | 26a2056 | 2013-09-26 07:40:04 -0500 | [diff] [blame] | 17 | #include <linux/of_fdt.h> |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 18 | #include <linux/of_platform.h> |
Benjamin Herrenschmidt | a125e09 | 2011-09-19 17:45:03 +0000 | [diff] [blame] | 19 | #include <linux/interrupt.h> |
Gavin Shan | 1bc98de | 2013-06-20 18:13:22 +0800 | [diff] [blame] | 20 | #include <linux/notifier.h> |
Benjamin Herrenschmidt | 73ed148 | 2013-05-10 16:59:18 +1000 | [diff] [blame] | 21 | #include <linux/slab.h> |
Mahesh Salgaonkar | b63a0ff | 2013-10-30 20:06:13 +0530 | [diff] [blame] | 22 | #include <linux/sched.h> |
Vasant Hegde | 6f68b5e | 2013-08-27 15:09:52 +0530 | [diff] [blame] | 23 | #include <linux/kobject.h> |
Vasant Hegde | f7d98d1 | 2014-01-15 17:02:04 +1100 | [diff] [blame] | 24 | #include <linux/delay.h> |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 25 | #include <linux/memblock.h> |
Benjamin Herrenschmidt | 3bf5756 | 2014-11-14 16:13:50 +1100 | [diff] [blame] | 26 | #include <linux/kthread.h> |
| 27 | #include <linux/freezer.h> |
Michael Ellerman | b14726c | 2014-07-15 22:22:24 +1000 | [diff] [blame] | 28 | |
| 29 | #include <asm/machdep.h> |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 30 | #include <asm/opal.h> |
| 31 | #include <asm/firmware.h> |
Mahesh Salgaonkar | 36df96f | 2013-10-30 20:05:40 +0530 | [diff] [blame] | 32 | #include <asm/mce.h> |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 33 | |
| 34 | #include "powernv.h" |
| 35 | |
Vasant Hegde | 6f68b5e | 2013-08-27 15:09:52 +0530 | [diff] [blame] | 36 | /* /sys/firmware/opal */ |
| 37 | struct kobject *opal_kobj; |
| 38 | |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 39 | struct opal { |
| 40 | u64 base; |
| 41 | u64 entry; |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 42 | u64 size; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 43 | } opal; |
| 44 | |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 45 | struct mcheck_recoverable_range { |
| 46 | u64 start_addr; |
| 47 | u64 end_addr; |
| 48 | u64 recover_addr; |
| 49 | }; |
| 50 | |
| 51 | static struct mcheck_recoverable_range *mc_recoverable_range; |
| 52 | static int mc_recoverable_range_len; |
| 53 | |
Joel Stanley | bfc3689 | 2014-04-01 14:28:19 +1030 | [diff] [blame] | 54 | struct device_node *opal_node; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 55 | static DEFINE_SPINLOCK(opal_write_lock); |
Benjamin Herrenschmidt | 73ed148 | 2013-05-10 16:59:18 +1000 | [diff] [blame] | 56 | static unsigned int *opal_irqs; |
| 57 | static unsigned int opal_irq_count; |
Gavin Shan | 1bc98de | 2013-06-20 18:13:22 +0800 | [diff] [blame] | 58 | static ATOMIC_NOTIFIER_HEAD(opal_notifier_head); |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 59 | static struct atomic_notifier_head opal_msg_notifier_head[OPAL_MSG_TYPE_MAX]; |
Gavin Shan | 1bc98de | 2013-06-20 18:13:22 +0800 | [diff] [blame] | 60 | static DEFINE_SPINLOCK(opal_notifier_lock); |
| 61 | static uint64_t last_notified_mask = 0x0ul; |
| 62 | static atomic_t opal_notifier_hold = ATOMIC_INIT(0); |
Benjamin Herrenschmidt | 3bf5756 | 2014-11-14 16:13:50 +1100 | [diff] [blame] | 63 | static uint32_t opal_heartbeat; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 64 | |
Benjamin Herrenschmidt | 4926616 | 2014-05-20 11:01:28 +1000 | [diff] [blame] | 65 | static void opal_reinit_cores(void) |
| 66 | { |
| 67 | /* Do the actual re-init, This will clobber all FPRs, VRs, etc... |
| 68 | * |
| 69 | * It will preserve non volatile GPRs and HSPRG0/1. It will |
| 70 | * also restore HIDs and other SPRs to their original value |
| 71 | * but it might clobber a bunch. |
| 72 | */ |
| 73 | #ifdef __BIG_ENDIAN__ |
| 74 | opal_reinit_cpus(OPAL_REINIT_CPUS_HILE_BE); |
| 75 | #else |
| 76 | opal_reinit_cpus(OPAL_REINIT_CPUS_HILE_LE); |
| 77 | #endif |
| 78 | } |
| 79 | |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 80 | int __init early_init_dt_scan_opal(unsigned long node, |
| 81 | const char *uname, int depth, void *data) |
| 82 | { |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 83 | const void *basep, *entryp, *sizep; |
Rob Herring | 9d0c4df | 2014-04-01 23:49:03 -0500 | [diff] [blame] | 84 | int basesz, entrysz, runtimesz; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 85 | |
| 86 | if (depth != 1 || strcmp(uname, "ibm,opal") != 0) |
| 87 | return 0; |
| 88 | |
| 89 | basep = of_get_flat_dt_prop(node, "opal-base-address", &basesz); |
| 90 | entryp = of_get_flat_dt_prop(node, "opal-entry-address", &entrysz); |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 91 | sizep = of_get_flat_dt_prop(node, "opal-runtime-size", &runtimesz); |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 92 | |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 93 | if (!basep || !entryp || !sizep) |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 94 | return 1; |
| 95 | |
| 96 | opal.base = of_read_number(basep, basesz/4); |
| 97 | opal.entry = of_read_number(entryp, entrysz/4); |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 98 | opal.size = of_read_number(sizep, runtimesz/4); |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 99 | |
Rob Herring | 9d0c4df | 2014-04-01 23:49:03 -0500 | [diff] [blame] | 100 | pr_debug("OPAL Base = 0x%llx (basep=%p basesz=%d)\n", |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 101 | opal.base, basep, basesz); |
Rob Herring | 9d0c4df | 2014-04-01 23:49:03 -0500 | [diff] [blame] | 102 | pr_debug("OPAL Entry = 0x%llx (entryp=%p basesz=%d)\n", |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 103 | opal.entry, entryp, entrysz); |
Rob Herring | 9d0c4df | 2014-04-01 23:49:03 -0500 | [diff] [blame] | 104 | pr_debug("OPAL Entry = 0x%llx (sizep=%p runtimesz=%d)\n", |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 105 | opal.size, sizep, runtimesz); |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 106 | |
| 107 | powerpc_firmware_features |= FW_FEATURE_OPAL; |
Benjamin Herrenschmidt | 75b93da | 2013-05-14 15:10:02 +1000 | [diff] [blame] | 108 | if (of_flat_dt_is_compatible(node, "ibm,opal-v3")) { |
| 109 | powerpc_firmware_features |= FW_FEATURE_OPALv2; |
| 110 | powerpc_firmware_features |= FW_FEATURE_OPALv3; |
Anton Blanchard | 9a4f5cd | 2014-09-17 14:39:38 +1000 | [diff] [blame] | 111 | pr_info("OPAL V3 detected !\n"); |
Benjamin Herrenschmidt | 75b93da | 2013-05-14 15:10:02 +1000 | [diff] [blame] | 112 | } else if (of_flat_dt_is_compatible(node, "ibm,opal-v2")) { |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 113 | powerpc_firmware_features |= FW_FEATURE_OPALv2; |
Anton Blanchard | 9a4f5cd | 2014-09-17 14:39:38 +1000 | [diff] [blame] | 114 | pr_info("OPAL V2 detected !\n"); |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 115 | } else { |
Anton Blanchard | 9a4f5cd | 2014-09-17 14:39:38 +1000 | [diff] [blame] | 116 | pr_info("OPAL V1 detected !\n"); |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 117 | } |
| 118 | |
Benjamin Herrenschmidt | 4926616 | 2014-05-20 11:01:28 +1000 | [diff] [blame] | 119 | /* Reinit all cores with the right endian */ |
| 120 | opal_reinit_cores(); |
| 121 | |
| 122 | /* Restore some bits */ |
| 123 | if (cur_cpu_spec->cpu_restore) |
| 124 | cur_cpu_spec->cpu_restore(); |
| 125 | |
Jeremy Kerr | c4463b3 | 2013-05-01 22:31:50 +0000 | [diff] [blame] | 126 | return 1; |
| 127 | } |
| 128 | |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 129 | int __init early_init_dt_scan_recoverable_ranges(unsigned long node, |
| 130 | const char *uname, int depth, void *data) |
| 131 | { |
Rob Herring | 9d0c4df | 2014-04-01 23:49:03 -0500 | [diff] [blame] | 132 | int i, psize, size; |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 133 | const __be32 *prop; |
| 134 | |
| 135 | if (depth != 1 || strcmp(uname, "ibm,opal") != 0) |
| 136 | return 0; |
| 137 | |
Mahesh Salgaonkar | 6e556b4 | 2014-03-30 11:03:23 +0530 | [diff] [blame] | 138 | prop = of_get_flat_dt_prop(node, "mcheck-recoverable-ranges", &psize); |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 139 | |
| 140 | if (!prop) |
| 141 | return 1; |
| 142 | |
| 143 | pr_debug("Found machine check recoverable ranges.\n"); |
| 144 | |
| 145 | /* |
Mahesh Salgaonkar | 6e556b4 | 2014-03-30 11:03:23 +0530 | [diff] [blame] | 146 | * Calculate number of available entries. |
| 147 | * |
| 148 | * Each recoverable address range entry is (start address, len, |
| 149 | * recovery address), 2 cells each for start and recovery address, |
| 150 | * 1 cell for len, totalling 5 cells per entry. |
| 151 | */ |
| 152 | mc_recoverable_range_len = psize / (sizeof(*prop) * 5); |
| 153 | |
| 154 | /* Sanity check */ |
| 155 | if (!mc_recoverable_range_len) |
| 156 | return 1; |
| 157 | |
| 158 | /* Size required to hold all the entries. */ |
| 159 | size = mc_recoverable_range_len * |
| 160 | sizeof(struct mcheck_recoverable_range); |
| 161 | |
| 162 | /* |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 163 | * Allocate a buffer to hold the MC recoverable ranges. We would be |
| 164 | * accessing them in real mode, hence it needs to be within |
| 165 | * RMO region. |
| 166 | */ |
| 167 | mc_recoverable_range =__va(memblock_alloc_base(size, __alignof__(u64), |
| 168 | ppc64_rma_size)); |
| 169 | memset(mc_recoverable_range, 0, size); |
| 170 | |
Mahesh Salgaonkar | 6e556b4 | 2014-03-30 11:03:23 +0530 | [diff] [blame] | 171 | for (i = 0; i < mc_recoverable_range_len; i++) { |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 172 | mc_recoverable_range[i].start_addr = |
| 173 | of_read_number(prop + (i * 5) + 0, 2); |
| 174 | mc_recoverable_range[i].end_addr = |
| 175 | mc_recoverable_range[i].start_addr + |
| 176 | of_read_number(prop + (i * 5) + 2, 1); |
| 177 | mc_recoverable_range[i].recover_addr = |
| 178 | of_read_number(prop + (i * 5) + 3, 2); |
| 179 | |
| 180 | pr_debug("Machine check recoverable range: %llx..%llx: %llx\n", |
| 181 | mc_recoverable_range[i].start_addr, |
| 182 | mc_recoverable_range[i].end_addr, |
| 183 | mc_recoverable_range[i].recover_addr); |
| 184 | } |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 185 | return 1; |
| 186 | } |
| 187 | |
Jeremy Kerr | c4463b3 | 2013-05-01 22:31:50 +0000 | [diff] [blame] | 188 | static int __init opal_register_exception_handlers(void) |
| 189 | { |
Benjamin Herrenschmidt | 2918609 | 2013-09-23 12:05:04 +1000 | [diff] [blame] | 190 | #ifdef __BIG_ENDIAN__ |
Jeremy Kerr | c4463b3 | 2013-05-01 22:31:50 +0000 | [diff] [blame] | 191 | u64 glue; |
| 192 | |
| 193 | if (!(powerpc_firmware_features & FW_FEATURE_OPAL)) |
| 194 | return -ENODEV; |
| 195 | |
Mahesh Salgaonkar | 28446de | 2013-10-30 20:05:58 +0530 | [diff] [blame] | 196 | /* Hookup some exception handlers except machine check. We use the |
| 197 | * fwnmi area at 0x7000 to provide the glue space to OPAL |
Benjamin Herrenschmidt | ed79ba9 | 2011-09-19 17:45:04 +0000 | [diff] [blame] | 198 | */ |
| 199 | glue = 0x7000; |
Mahesh Salgaonkar | 6507955c | 2014-10-10 21:28:26 +0530 | [diff] [blame] | 200 | |
| 201 | /* |
| 202 | * Check if we are running on newer firmware that exports |
| 203 | * OPAL_HANDLE_HMI token. If yes, then don't ask OPAL to patch |
| 204 | * the HMI interrupt and we catch it directly in Linux. |
| 205 | * |
| 206 | * For older firmware (i.e currently released POWER8 System Firmware |
| 207 | * as of today <= SV810_087), we fallback to old behavior and let OPAL |
| 208 | * patch the HMI vector and handle it inside OPAL firmware. |
| 209 | * |
| 210 | * For newer firmware (in development/yet to be released) we will |
| 211 | * start catching/handling HMI directly in Linux. |
| 212 | */ |
| 213 | if (!opal_check_token(OPAL_HANDLE_HMI)) { |
Michael Ellerman | 0813513 | 2015-01-28 15:10:33 +1100 | [diff] [blame] | 214 | pr_info("Old firmware detected, OPAL handles HMIs.\n"); |
Mahesh Salgaonkar | 6507955c | 2014-10-10 21:28:26 +0530 | [diff] [blame] | 215 | opal_register_exception_handler( |
| 216 | OPAL_HYPERVISOR_MAINTENANCE_HANDLER, |
| 217 | 0, glue); |
| 218 | glue += 128; |
| 219 | } |
| 220 | |
Benjamin Herrenschmidt | ed79ba9 | 2011-09-19 17:45:04 +0000 | [diff] [blame] | 221 | opal_register_exception_handler(OPAL_SOFTPATCH_HANDLER, 0, glue); |
Benjamin Herrenschmidt | 2918609 | 2013-09-23 12:05:04 +1000 | [diff] [blame] | 222 | #endif |
Benjamin Herrenschmidt | ed79ba9 | 2011-09-19 17:45:04 +0000 | [diff] [blame] | 223 | |
Jeremy Kerr | c4463b3 | 2013-05-01 22:31:50 +0000 | [diff] [blame] | 224 | return 0; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 225 | } |
Michael Ellerman | b14726c | 2014-07-15 22:22:24 +1000 | [diff] [blame] | 226 | machine_early_initcall(powernv, opal_register_exception_handlers); |
Jeremy Kerr | c4463b3 | 2013-05-01 22:31:50 +0000 | [diff] [blame] | 227 | |
Gavin Shan | 1bc98de | 2013-06-20 18:13:22 +0800 | [diff] [blame] | 228 | int opal_notifier_register(struct notifier_block *nb) |
| 229 | { |
| 230 | if (!nb) { |
| 231 | pr_warning("%s: Invalid argument (%p)\n", |
| 232 | __func__, nb); |
| 233 | return -EINVAL; |
| 234 | } |
| 235 | |
| 236 | atomic_notifier_chain_register(&opal_notifier_head, nb); |
| 237 | return 0; |
| 238 | } |
Benjamin Herrenschmidt | 798af00 | 2014-03-28 13:36:31 +1100 | [diff] [blame] | 239 | EXPORT_SYMBOL_GPL(opal_notifier_register); |
| 240 | |
| 241 | int opal_notifier_unregister(struct notifier_block *nb) |
| 242 | { |
| 243 | if (!nb) { |
| 244 | pr_warning("%s: Invalid argument (%p)\n", |
| 245 | __func__, nb); |
| 246 | return -EINVAL; |
| 247 | } |
| 248 | |
| 249 | atomic_notifier_chain_unregister(&opal_notifier_head, nb); |
| 250 | return 0; |
| 251 | } |
| 252 | EXPORT_SYMBOL_GPL(opal_notifier_unregister); |
Gavin Shan | 1bc98de | 2013-06-20 18:13:22 +0800 | [diff] [blame] | 253 | |
| 254 | static void opal_do_notifier(uint64_t events) |
| 255 | { |
| 256 | unsigned long flags; |
| 257 | uint64_t changed_mask; |
| 258 | |
| 259 | if (atomic_read(&opal_notifier_hold)) |
| 260 | return; |
| 261 | |
| 262 | spin_lock_irqsave(&opal_notifier_lock, flags); |
| 263 | changed_mask = last_notified_mask ^ events; |
| 264 | last_notified_mask = events; |
| 265 | spin_unlock_irqrestore(&opal_notifier_lock, flags); |
| 266 | |
| 267 | /* |
| 268 | * We feed with the event bits and changed bits for |
| 269 | * enough information to the callback. |
| 270 | */ |
| 271 | atomic_notifier_call_chain(&opal_notifier_head, |
| 272 | events, (void *)changed_mask); |
| 273 | } |
| 274 | |
| 275 | void opal_notifier_update_evt(uint64_t evt_mask, |
| 276 | uint64_t evt_val) |
| 277 | { |
| 278 | unsigned long flags; |
| 279 | |
| 280 | spin_lock_irqsave(&opal_notifier_lock, flags); |
| 281 | last_notified_mask &= ~evt_mask; |
| 282 | last_notified_mask |= evt_val; |
| 283 | spin_unlock_irqrestore(&opal_notifier_lock, flags); |
| 284 | } |
| 285 | |
| 286 | void opal_notifier_enable(void) |
| 287 | { |
| 288 | int64_t rc; |
Anton Blanchard | 56b4c99 | 2014-04-22 15:01:24 +1000 | [diff] [blame] | 289 | __be64 evt = 0; |
Gavin Shan | 1bc98de | 2013-06-20 18:13:22 +0800 | [diff] [blame] | 290 | |
| 291 | atomic_set(&opal_notifier_hold, 0); |
| 292 | |
| 293 | /* Process pending events */ |
| 294 | rc = opal_poll_events(&evt); |
| 295 | if (rc == OPAL_SUCCESS && evt) |
Anton Blanchard | 56b4c99 | 2014-04-22 15:01:24 +1000 | [diff] [blame] | 296 | opal_do_notifier(be64_to_cpu(evt)); |
Gavin Shan | 1bc98de | 2013-06-20 18:13:22 +0800 | [diff] [blame] | 297 | } |
| 298 | |
| 299 | void opal_notifier_disable(void) |
| 300 | { |
| 301 | atomic_set(&opal_notifier_hold, 1); |
| 302 | } |
| 303 | |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 304 | /* |
| 305 | * Opal message notifier based on message type. Allow subscribers to get |
| 306 | * notified for specific messgae type. |
| 307 | */ |
| 308 | int opal_message_notifier_register(enum OpalMessageType msg_type, |
| 309 | struct notifier_block *nb) |
| 310 | { |
Neelesh Gupta | 792f96e | 2015-02-11 11:57:06 +0530 | [diff] [blame] | 311 | if (!nb || msg_type >= OPAL_MSG_TYPE_MAX) { |
| 312 | pr_warning("%s: Invalid arguments, msg_type:%d\n", |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 313 | __func__, msg_type); |
| 314 | return -EINVAL; |
| 315 | } |
Neelesh Gupta | 792f96e | 2015-02-11 11:57:06 +0530 | [diff] [blame] | 316 | |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 317 | return atomic_notifier_chain_register( |
| 318 | &opal_msg_notifier_head[msg_type], nb); |
| 319 | } |
| 320 | |
Neelesh Gupta | b921e90 | 2015-02-11 11:57:23 +0530 | [diff] [blame^] | 321 | int opal_message_notifier_unregister(enum OpalMessageType msg_type, |
| 322 | struct notifier_block *nb) |
| 323 | { |
| 324 | return atomic_notifier_chain_unregister( |
| 325 | &opal_msg_notifier_head[msg_type], nb); |
| 326 | } |
| 327 | |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 328 | static void opal_message_do_notify(uint32_t msg_type, void *msg) |
| 329 | { |
| 330 | /* notify subscribers */ |
| 331 | atomic_notifier_call_chain(&opal_msg_notifier_head[msg_type], |
| 332 | msg_type, msg); |
| 333 | } |
| 334 | |
| 335 | static void opal_handle_message(void) |
| 336 | { |
| 337 | s64 ret; |
| 338 | /* |
| 339 | * TODO: pre-allocate a message buffer depending on opal-msg-size |
| 340 | * value in /proc/device-tree. |
| 341 | */ |
| 342 | static struct opal_msg msg; |
Anton Blanchard | bb4398e | 2014-03-28 16:33:33 +1100 | [diff] [blame] | 343 | u32 type; |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 344 | |
| 345 | ret = opal_get_msg(__pa(&msg), sizeof(msg)); |
| 346 | /* No opal message pending. */ |
| 347 | if (ret == OPAL_RESOURCE) |
| 348 | return; |
| 349 | |
| 350 | /* check for errors. */ |
| 351 | if (ret) { |
Masanari Iida | 1a84db5 | 2014-08-29 23:37:33 +0900 | [diff] [blame] | 352 | pr_warning("%s: Failed to retrieve opal message, err=%lld\n", |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 353 | __func__, ret); |
| 354 | return; |
| 355 | } |
| 356 | |
Anton Blanchard | bb4398e | 2014-03-28 16:33:33 +1100 | [diff] [blame] | 357 | type = be32_to_cpu(msg.msg_type); |
| 358 | |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 359 | /* Sanity check */ |
Neelesh Gupta | 792f96e | 2015-02-11 11:57:06 +0530 | [diff] [blame] | 360 | if (type >= OPAL_MSG_TYPE_MAX) { |
Anton Blanchard | bb4398e | 2014-03-28 16:33:33 +1100 | [diff] [blame] | 361 | pr_warning("%s: Unknown message type: %u\n", __func__, type); |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 362 | return; |
| 363 | } |
Anton Blanchard | bb4398e | 2014-03-28 16:33:33 +1100 | [diff] [blame] | 364 | opal_message_do_notify(type, (void *)&msg); |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 365 | } |
| 366 | |
| 367 | static int opal_message_notify(struct notifier_block *nb, |
| 368 | unsigned long events, void *change) |
| 369 | { |
| 370 | if (events & OPAL_EVENT_MSG_PENDING) |
| 371 | opal_handle_message(); |
| 372 | return 0; |
| 373 | } |
| 374 | |
| 375 | static struct notifier_block opal_message_nb = { |
| 376 | .notifier_call = opal_message_notify, |
| 377 | .next = NULL, |
| 378 | .priority = 0, |
| 379 | }; |
| 380 | |
| 381 | static int __init opal_message_init(void) |
| 382 | { |
| 383 | int ret, i; |
| 384 | |
| 385 | for (i = 0; i < OPAL_MSG_TYPE_MAX; i++) |
| 386 | ATOMIC_INIT_NOTIFIER_HEAD(&opal_msg_notifier_head[i]); |
| 387 | |
| 388 | ret = opal_notifier_register(&opal_message_nb); |
| 389 | if (ret) { |
| 390 | pr_err("%s: Can't register OPAL event notifier (%d)\n", |
| 391 | __func__, ret); |
| 392 | return ret; |
| 393 | } |
| 394 | return 0; |
| 395 | } |
Michael Ellerman | b14726c | 2014-07-15 22:22:24 +1000 | [diff] [blame] | 396 | machine_early_initcall(powernv, opal_message_init); |
Mahesh Salgaonkar | 2436636 | 2013-11-18 15:35:58 +0530 | [diff] [blame] | 397 | |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 398 | int opal_get_chars(uint32_t vtermno, char *buf, int count) |
| 399 | { |
Benjamin Herrenschmidt | 4f89363 | 2013-09-23 12:05:02 +1000 | [diff] [blame] | 400 | s64 rc; |
| 401 | __be64 evt, len; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 402 | |
| 403 | if (!opal.entry) |
Benjamin Herrenschmidt | daea117 | 2011-09-19 17:44:59 +0000 | [diff] [blame] | 404 | return -ENODEV; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 405 | opal_poll_events(&evt); |
Benjamin Herrenschmidt | 4f89363 | 2013-09-23 12:05:02 +1000 | [diff] [blame] | 406 | if ((be64_to_cpu(evt) & OPAL_EVENT_CONSOLE_INPUT) == 0) |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 407 | return 0; |
Benjamin Herrenschmidt | 4f89363 | 2013-09-23 12:05:02 +1000 | [diff] [blame] | 408 | len = cpu_to_be64(count); |
Rob Herring | 9d0c4df | 2014-04-01 23:49:03 -0500 | [diff] [blame] | 409 | rc = opal_console_read(vtermno, &len, buf); |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 410 | if (rc == OPAL_SUCCESS) |
Benjamin Herrenschmidt | 4f89363 | 2013-09-23 12:05:02 +1000 | [diff] [blame] | 411 | return be64_to_cpu(len); |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 412 | return 0; |
| 413 | } |
| 414 | |
| 415 | int opal_put_chars(uint32_t vtermno, const char *data, int total_len) |
| 416 | { |
| 417 | int written = 0; |
Benjamin Herrenschmidt | 4f89363 | 2013-09-23 12:05:02 +1000 | [diff] [blame] | 418 | __be64 olen; |
Benjamin Herrenschmidt | daea117 | 2011-09-19 17:44:59 +0000 | [diff] [blame] | 419 | s64 len, rc; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 420 | unsigned long flags; |
Benjamin Herrenschmidt | 4f89363 | 2013-09-23 12:05:02 +1000 | [diff] [blame] | 421 | __be64 evt; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 422 | |
| 423 | if (!opal.entry) |
Benjamin Herrenschmidt | daea117 | 2011-09-19 17:44:59 +0000 | [diff] [blame] | 424 | return -ENODEV; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 425 | |
| 426 | /* We want put_chars to be atomic to avoid mangling of hvsi |
| 427 | * packets. To do that, we first test for room and return |
Benjamin Herrenschmidt | daea117 | 2011-09-19 17:44:59 +0000 | [diff] [blame] | 428 | * -EAGAIN if there isn't enough. |
| 429 | * |
| 430 | * Unfortunately, opal_console_write_buffer_space() doesn't |
| 431 | * appear to work on opal v1, so we just assume there is |
| 432 | * enough room and be done with it |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 433 | */ |
| 434 | spin_lock_irqsave(&opal_write_lock, flags); |
Benjamin Herrenschmidt | daea117 | 2011-09-19 17:44:59 +0000 | [diff] [blame] | 435 | if (firmware_has_feature(FW_FEATURE_OPALv2)) { |
Benjamin Herrenschmidt | 4f89363 | 2013-09-23 12:05:02 +1000 | [diff] [blame] | 436 | rc = opal_console_write_buffer_space(vtermno, &olen); |
| 437 | len = be64_to_cpu(olen); |
Benjamin Herrenschmidt | daea117 | 2011-09-19 17:44:59 +0000 | [diff] [blame] | 438 | if (rc || len < total_len) { |
| 439 | spin_unlock_irqrestore(&opal_write_lock, flags); |
| 440 | /* Closed -> drop characters */ |
| 441 | if (rc) |
| 442 | return total_len; |
Benjamin Herrenschmidt | 4f89363 | 2013-09-23 12:05:02 +1000 | [diff] [blame] | 443 | opal_poll_events(NULL); |
Benjamin Herrenschmidt | daea117 | 2011-09-19 17:44:59 +0000 | [diff] [blame] | 444 | return -EAGAIN; |
| 445 | } |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 446 | } |
| 447 | |
| 448 | /* We still try to handle partial completions, though they |
| 449 | * should no longer happen. |
| 450 | */ |
Benjamin Herrenschmidt | daea117 | 2011-09-19 17:44:59 +0000 | [diff] [blame] | 451 | rc = OPAL_BUSY; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 452 | while(total_len > 0 && (rc == OPAL_BUSY || |
| 453 | rc == OPAL_BUSY_EVENT || rc == OPAL_SUCCESS)) { |
Benjamin Herrenschmidt | 4f89363 | 2013-09-23 12:05:02 +1000 | [diff] [blame] | 454 | olen = cpu_to_be64(total_len); |
| 455 | rc = opal_console_write(vtermno, &olen, data); |
| 456 | len = be64_to_cpu(olen); |
Benjamin Herrenschmidt | 1de1455 | 2013-05-08 14:14:26 +1000 | [diff] [blame] | 457 | |
| 458 | /* Closed or other error drop */ |
| 459 | if (rc != OPAL_SUCCESS && rc != OPAL_BUSY && |
| 460 | rc != OPAL_BUSY_EVENT) { |
| 461 | written = total_len; |
| 462 | break; |
| 463 | } |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 464 | if (rc == OPAL_SUCCESS) { |
| 465 | total_len -= len; |
| 466 | data += len; |
| 467 | written += len; |
| 468 | } |
| 469 | /* This is a bit nasty but we need that for the console to |
| 470 | * flush when there aren't any interrupts. We will clean |
| 471 | * things a bit later to limit that to synchronous path |
| 472 | * such as the kernel console and xmon/udbg |
| 473 | */ |
| 474 | do |
| 475 | opal_poll_events(&evt); |
Benjamin Herrenschmidt | 4f89363 | 2013-09-23 12:05:02 +1000 | [diff] [blame] | 476 | while(rc == OPAL_SUCCESS && |
| 477 | (be64_to_cpu(evt) & OPAL_EVENT_CONSOLE_OUTPUT)); |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 478 | } |
| 479 | spin_unlock_irqrestore(&opal_write_lock, flags); |
| 480 | return written; |
| 481 | } |
| 482 | |
Mahesh Salgaonkar | b63a0ff | 2013-10-30 20:06:13 +0530 | [diff] [blame] | 483 | static int opal_recover_mce(struct pt_regs *regs, |
| 484 | struct machine_check_event *evt) |
| 485 | { |
| 486 | int recovered = 0; |
| 487 | uint64_t ea = get_mce_fault_addr(evt); |
| 488 | |
| 489 | if (!(regs->msr & MSR_RI)) { |
| 490 | /* If MSR_RI isn't set, we cannot recover */ |
| 491 | recovered = 0; |
| 492 | } else if (evt->disposition == MCE_DISPOSITION_RECOVERED) { |
| 493 | /* Platform corrected itself */ |
| 494 | recovered = 1; |
| 495 | } else if (ea && !is_kernel_addr(ea)) { |
| 496 | /* |
| 497 | * Faulting address is not in kernel text. We should be fine. |
| 498 | * We need to find which process uses this address. |
| 499 | * For now, kill the task if we have received exception when |
| 500 | * in userspace. |
| 501 | * |
| 502 | * TODO: Queue up this address for hwpoisioning later. |
| 503 | */ |
| 504 | if (user_mode(regs) && !is_global_init(current)) { |
| 505 | _exception(SIGBUS, regs, BUS_MCEERR_AR, regs->nip); |
| 506 | recovered = 1; |
| 507 | } else |
| 508 | recovered = 0; |
| 509 | } else if (user_mode(regs) && !is_global_init(current) && |
| 510 | evt->severity == MCE_SEV_ERROR_SYNC) { |
| 511 | /* |
| 512 | * If we have received a synchronous error when in userspace |
| 513 | * kill the task. |
| 514 | */ |
| 515 | _exception(SIGBUS, regs, BUS_MCEERR_AR, regs->nip); |
| 516 | recovered = 1; |
| 517 | } |
| 518 | return recovered; |
| 519 | } |
| 520 | |
Benjamin Herrenschmidt | ed79ba9 | 2011-09-19 17:45:04 +0000 | [diff] [blame] | 521 | int opal_machine_check(struct pt_regs *regs) |
| 522 | { |
Mahesh Salgaonkar | 36df96f | 2013-10-30 20:05:40 +0530 | [diff] [blame] | 523 | struct machine_check_event evt; |
Benjamin Herrenschmidt | ed79ba9 | 2011-09-19 17:45:04 +0000 | [diff] [blame] | 524 | |
Mahesh Salgaonkar | 36df96f | 2013-10-30 20:05:40 +0530 | [diff] [blame] | 525 | if (!get_mce_event(&evt, MCE_EVENT_RELEASE)) |
| 526 | return 0; |
Benjamin Herrenschmidt | ed79ba9 | 2011-09-19 17:45:04 +0000 | [diff] [blame] | 527 | |
| 528 | /* Print things out */ |
Mahesh Salgaonkar | 36df96f | 2013-10-30 20:05:40 +0530 | [diff] [blame] | 529 | if (evt.version != MCE_V1) { |
Benjamin Herrenschmidt | ed79ba9 | 2011-09-19 17:45:04 +0000 | [diff] [blame] | 530 | pr_err("Machine Check Exception, Unknown event version %d !\n", |
| 531 | evt.version); |
| 532 | return 0; |
| 533 | } |
Mahesh Salgaonkar | b5ff421 | 2013-10-30 20:05:49 +0530 | [diff] [blame] | 534 | machine_check_print_event_info(&evt); |
Benjamin Herrenschmidt | ed79ba9 | 2011-09-19 17:45:04 +0000 | [diff] [blame] | 535 | |
Mahesh Salgaonkar | b63a0ff | 2013-10-30 20:06:13 +0530 | [diff] [blame] | 536 | if (opal_recover_mce(regs, &evt)) |
| 537 | return 1; |
| 538 | return 0; |
Benjamin Herrenschmidt | ed79ba9 | 2011-09-19 17:45:04 +0000 | [diff] [blame] | 539 | } |
| 540 | |
Mahesh Salgaonkar | 0869b6f | 2014-07-29 18:40:01 +0530 | [diff] [blame] | 541 | /* Early hmi handler called in real mode. */ |
| 542 | int opal_hmi_exception_early(struct pt_regs *regs) |
| 543 | { |
Mahesh Salgaonkar | 0ef95b4 | 2014-07-29 18:40:07 +0530 | [diff] [blame] | 544 | s64 rc; |
| 545 | |
| 546 | /* |
| 547 | * call opal hmi handler. Pass paca address as token. |
| 548 | * The return value OPAL_SUCCESS is an indication that there is |
| 549 | * an HMI event generated waiting to pull by Linux. |
| 550 | */ |
| 551 | rc = opal_handle_hmi(); |
| 552 | if (rc == OPAL_SUCCESS) { |
| 553 | local_paca->hmi_event_available = 1; |
| 554 | return 1; |
| 555 | } |
Mahesh Salgaonkar | 0869b6f | 2014-07-29 18:40:01 +0530 | [diff] [blame] | 556 | return 0; |
| 557 | } |
| 558 | |
| 559 | /* HMI exception handler called in virtual mode during check_irq_replay. */ |
| 560 | int opal_handle_hmi_exception(struct pt_regs *regs) |
| 561 | { |
Mahesh Salgaonkar | 0ef95b4 | 2014-07-29 18:40:07 +0530 | [diff] [blame] | 562 | s64 rc; |
| 563 | __be64 evt = 0; |
| 564 | |
| 565 | /* |
| 566 | * Check if HMI event is available. |
| 567 | * if Yes, then call opal_poll_events to pull opal messages and |
| 568 | * process them. |
| 569 | */ |
| 570 | if (!local_paca->hmi_event_available) |
| 571 | return 0; |
| 572 | |
| 573 | local_paca->hmi_event_available = 0; |
| 574 | rc = opal_poll_events(&evt); |
| 575 | if (rc == OPAL_SUCCESS && evt) |
| 576 | opal_do_notifier(be64_to_cpu(evt)); |
| 577 | |
| 578 | return 1; |
Mahesh Salgaonkar | 0869b6f | 2014-07-29 18:40:01 +0530 | [diff] [blame] | 579 | } |
| 580 | |
Mahesh Salgaonkar | 55672ec | 2013-12-16 10:46:24 +0530 | [diff] [blame] | 581 | static uint64_t find_recovery_address(uint64_t nip) |
| 582 | { |
| 583 | int i; |
| 584 | |
| 585 | for (i = 0; i < mc_recoverable_range_len; i++) |
| 586 | if ((nip >= mc_recoverable_range[i].start_addr) && |
| 587 | (nip < mc_recoverable_range[i].end_addr)) |
| 588 | return mc_recoverable_range[i].recover_addr; |
| 589 | return 0; |
| 590 | } |
| 591 | |
| 592 | bool opal_mce_check_early_recovery(struct pt_regs *regs) |
| 593 | { |
| 594 | uint64_t recover_addr = 0; |
| 595 | |
| 596 | if (!opal.base || !opal.size) |
| 597 | goto out; |
| 598 | |
| 599 | if ((regs->nip >= opal.base) && |
| 600 | (regs->nip <= (opal.base + opal.size))) |
| 601 | recover_addr = find_recovery_address(regs->nip); |
| 602 | |
| 603 | /* |
| 604 | * Setup regs->nip to rfi into fixup address. |
| 605 | */ |
| 606 | if (recover_addr) |
| 607 | regs->nip = recover_addr; |
| 608 | |
| 609 | out: |
| 610 | return !!recover_addr; |
| 611 | } |
| 612 | |
Benjamin Herrenschmidt | a125e09 | 2011-09-19 17:45:03 +0000 | [diff] [blame] | 613 | static irqreturn_t opal_interrupt(int irq, void *data) |
| 614 | { |
Anton Blanchard | 5e4da53 | 2013-09-23 12:05:06 +1000 | [diff] [blame] | 615 | __be64 events; |
Benjamin Herrenschmidt | a125e09 | 2011-09-19 17:45:03 +0000 | [diff] [blame] | 616 | |
| 617 | opal_handle_interrupt(virq_to_hw(irq), &events); |
| 618 | |
Anton Blanchard | 56b4c99 | 2014-04-22 15:01:24 +1000 | [diff] [blame] | 619 | opal_do_notifier(be64_to_cpu(events)); |
Benjamin Herrenschmidt | a125e09 | 2011-09-19 17:45:03 +0000 | [diff] [blame] | 620 | |
| 621 | return IRQ_HANDLED; |
| 622 | } |
| 623 | |
Vasant Hegde | 6f68b5e | 2013-08-27 15:09:52 +0530 | [diff] [blame] | 624 | static int opal_sysfs_init(void) |
| 625 | { |
| 626 | opal_kobj = kobject_create_and_add("opal", firmware_kobj); |
| 627 | if (!opal_kobj) { |
| 628 | pr_warn("kobject_create_and_add opal failed\n"); |
| 629 | return -ENOMEM; |
| 630 | } |
| 631 | |
| 632 | return 0; |
| 633 | } |
| 634 | |
Benjamin Herrenschmidt | c8742f8 | 2014-12-11 12:39:49 +1100 | [diff] [blame] | 635 | static ssize_t symbol_map_read(struct file *fp, struct kobject *kobj, |
| 636 | struct bin_attribute *bin_attr, |
| 637 | char *buf, loff_t off, size_t count) |
| 638 | { |
| 639 | return memory_read_from_buffer(buf, count, &off, bin_attr->private, |
| 640 | bin_attr->size); |
| 641 | } |
| 642 | |
| 643 | static BIN_ATTR_RO(symbol_map, 0); |
| 644 | |
| 645 | static void opal_export_symmap(void) |
| 646 | { |
| 647 | const __be64 *syms; |
| 648 | unsigned int size; |
| 649 | struct device_node *fw; |
| 650 | int rc; |
| 651 | |
| 652 | fw = of_find_node_by_path("/ibm,opal/firmware"); |
| 653 | if (!fw) |
| 654 | return; |
| 655 | syms = of_get_property(fw, "symbol-map", &size); |
| 656 | if (!syms || size != 2 * sizeof(__be64)) |
| 657 | return; |
| 658 | |
| 659 | /* Setup attributes */ |
| 660 | bin_attr_symbol_map.private = __va(be64_to_cpu(syms[0])); |
| 661 | bin_attr_symbol_map.size = be64_to_cpu(syms[1]); |
| 662 | |
| 663 | rc = sysfs_create_bin_file(opal_kobj, &bin_attr_symbol_map); |
| 664 | if (rc) |
| 665 | pr_warn("Error %d creating OPAL symbols file\n", rc); |
| 666 | } |
| 667 | |
Vasant Hegde | b09c2ec | 2014-08-09 11:15:45 +0530 | [diff] [blame] | 668 | static void __init opal_dump_region_init(void) |
| 669 | { |
| 670 | void *addr; |
| 671 | uint64_t size; |
| 672 | int rc; |
| 673 | |
| 674 | /* Register kernel log buffer */ |
| 675 | addr = log_buf_addr_get(); |
Pranith Kumar | 6501ab5e3 | 2015-01-21 21:26:09 -0500 | [diff] [blame] | 676 | if (addr == NULL) |
| 677 | return; |
| 678 | |
Vasant Hegde | b09c2ec | 2014-08-09 11:15:45 +0530 | [diff] [blame] | 679 | size = log_buf_len_get(); |
Pranith Kumar | 6501ab5e3 | 2015-01-21 21:26:09 -0500 | [diff] [blame] | 680 | if (size == 0) |
| 681 | return; |
| 682 | |
Vasant Hegde | b09c2ec | 2014-08-09 11:15:45 +0530 | [diff] [blame] | 683 | rc = opal_register_dump_region(OPAL_DUMP_REGION_LOG_BUF, |
| 684 | __pa(addr), size); |
| 685 | /* Don't warn if this is just an older OPAL that doesn't |
| 686 | * know about that call |
| 687 | */ |
| 688 | if (rc && rc != OPAL_UNSUPPORTED) |
| 689 | pr_warn("DUMP: Failed to register kernel log buffer. " |
| 690 | "rc = %d\n", rc); |
| 691 | } |
Jeremy Kerr | 608b286 | 2014-11-06 11:38:27 +0800 | [diff] [blame] | 692 | |
| 693 | static void opal_ipmi_init(struct device_node *opal_node) |
| 694 | { |
| 695 | struct device_node *np; |
| 696 | |
| 697 | for_each_child_of_node(opal_node, np) |
| 698 | if (of_device_is_compatible(np, "ibm,opal-ipmi")) |
| 699 | of_platform_device_create(np, NULL, NULL); |
| 700 | } |
| 701 | |
Neelesh Gupta | 4708345 | 2014-12-13 23:31:05 +0530 | [diff] [blame] | 702 | static void opal_i2c_create_devs(void) |
| 703 | { |
| 704 | struct device_node *np; |
| 705 | |
| 706 | for_each_compatible_node(np, NULL, "ibm,opal-i2c") |
| 707 | of_platform_device_create(np, NULL, NULL); |
| 708 | } |
| 709 | |
Gavin Shan | c1c3a52 | 2015-01-23 14:25:05 +1100 | [diff] [blame] | 710 | static void __init opal_irq_init(struct device_node *dn) |
| 711 | { |
| 712 | const __be32 *irqs; |
| 713 | int i, irqlen; |
| 714 | |
| 715 | /* Get interrupt property */ |
| 716 | irqs = of_get_property(opal_node, "opal-interrupts", &irqlen); |
Gavin Shan | 31494cf | 2015-01-23 14:25:06 +1100 | [diff] [blame] | 717 | opal_irq_count = irqs ? (irqlen / 4) : 0; |
| 718 | pr_debug("Found %d interrupts reserved for OPAL\n", opal_irq_count); |
| 719 | if (!opal_irq_count) |
| 720 | return; |
Gavin Shan | c1c3a52 | 2015-01-23 14:25:05 +1100 | [diff] [blame] | 721 | |
| 722 | /* Install interrupt handlers */ |
Gavin Shan | c1c3a52 | 2015-01-23 14:25:05 +1100 | [diff] [blame] | 723 | opal_irqs = kzalloc(opal_irq_count * sizeof(unsigned int), GFP_KERNEL); |
| 724 | for (i = 0; irqs && i < opal_irq_count; i++, irqs++) { |
| 725 | unsigned int irq, virq; |
| 726 | int rc; |
| 727 | |
| 728 | /* Get hardware and virtual IRQ */ |
| 729 | irq = be32_to_cpup(irqs); |
| 730 | virq = irq_create_mapping(NULL, irq); |
| 731 | if (virq == NO_IRQ) { |
| 732 | pr_warn("Failed to map irq 0x%x\n", irq); |
| 733 | continue; |
| 734 | } |
| 735 | |
| 736 | /* Install interrupt handler */ |
| 737 | rc = request_irq(virq, opal_interrupt, 0, "opal", NULL); |
| 738 | if (rc) { |
| 739 | irq_dispose_mapping(virq); |
| 740 | pr_warn("Error %d requesting irq %d (0x%x)\n", |
| 741 | rc, virq, irq); |
| 742 | continue; |
| 743 | } |
| 744 | |
| 745 | /* Cache IRQ */ |
| 746 | opal_irqs[i] = virq; |
| 747 | } |
| 748 | } |
| 749 | |
Benjamin Herrenschmidt | 3bf5756 | 2014-11-14 16:13:50 +1100 | [diff] [blame] | 750 | static int kopald(void *unused) |
| 751 | { |
| 752 | set_freezable(); |
| 753 | do { |
| 754 | try_to_freeze(); |
| 755 | opal_poll_events(NULL); |
| 756 | msleep_interruptible(opal_heartbeat); |
| 757 | } while (!kthread_should_stop()); |
| 758 | |
| 759 | return 0; |
| 760 | } |
| 761 | |
| 762 | static void opal_init_heartbeat(void) |
| 763 | { |
| 764 | /* Old firwmware, we assume the HVC heartbeat is sufficient */ |
| 765 | if (of_property_read_u32(opal_node, "ibm,heartbeat-ms", |
| 766 | &opal_heartbeat) != 0) |
| 767 | opal_heartbeat = 0; |
| 768 | |
| 769 | if (opal_heartbeat) |
| 770 | kthread_run(kopald, NULL, "kopald"); |
| 771 | } |
| 772 | |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 773 | static int __init opal_init(void) |
| 774 | { |
| 775 | struct device_node *np, *consoles; |
Gavin Shan | c1c3a52 | 2015-01-23 14:25:05 +1100 | [diff] [blame] | 776 | int rc; |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 777 | |
| 778 | opal_node = of_find_node_by_path("/ibm,opal"); |
| 779 | if (!opal_node) { |
Michael Ellerman | 0813513 | 2015-01-28 15:10:33 +1100 | [diff] [blame] | 780 | pr_warn("Device node not found\n"); |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 781 | return -ENODEV; |
| 782 | } |
Benjamin Herrenschmidt | 2db29d2 | 2013-07-15 13:03:14 +1000 | [diff] [blame] | 783 | |
| 784 | /* Register OPAL consoles if any ports */ |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 785 | if (firmware_has_feature(FW_FEATURE_OPALv2)) |
| 786 | consoles = of_find_node_by_path("/ibm,opal/consoles"); |
| 787 | else |
| 788 | consoles = of_node_get(opal_node); |
Benjamin Herrenschmidt | 2db29d2 | 2013-07-15 13:03:14 +1000 | [diff] [blame] | 789 | if (consoles) { |
| 790 | for_each_child_of_node(consoles, np) { |
| 791 | if (strcmp(np->name, "serial")) |
| 792 | continue; |
| 793 | of_platform_device_create(np, NULL, NULL); |
| 794 | } |
| 795 | of_node_put(consoles); |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 796 | } |
Benjamin Herrenschmidt | a125e09 | 2011-09-19 17:45:03 +0000 | [diff] [blame] | 797 | |
Neelesh Gupta | 4708345 | 2014-12-13 23:31:05 +0530 | [diff] [blame] | 798 | /* Create i2c platform devices */ |
| 799 | opal_i2c_create_devs(); |
| 800 | |
Benjamin Herrenschmidt | 3bf5756 | 2014-11-14 16:13:50 +1100 | [diff] [blame] | 801 | /* Setup a heatbeat thread if requested by OPAL */ |
| 802 | opal_init_heartbeat(); |
| 803 | |
Benjamin Herrenschmidt | a125e09 | 2011-09-19 17:45:03 +0000 | [diff] [blame] | 804 | /* Find all OPAL interrupts and request them */ |
Gavin Shan | c1c3a52 | 2015-01-23 14:25:05 +1100 | [diff] [blame] | 805 | opal_irq_init(opal_node); |
Vasant Hegde | 6f68b5e | 2013-08-27 15:09:52 +0530 | [diff] [blame] | 806 | |
| 807 | /* Create "opal" kobject under /sys/firmware */ |
| 808 | rc = opal_sysfs_init(); |
Vasant Hegde | 50bd615 | 2013-10-24 16:04:58 +0530 | [diff] [blame] | 809 | if (rc == 0) { |
Benjamin Herrenschmidt | c8742f8 | 2014-12-11 12:39:49 +1100 | [diff] [blame] | 810 | /* Export symbol map to userspace */ |
| 811 | opal_export_symmap(); |
Vasant Hegde | b09c2ec | 2014-08-09 11:15:45 +0530 | [diff] [blame] | 812 | /* Setup dump region interface */ |
| 813 | opal_dump_region_init(); |
Stewart Smith | 774fea1 | 2014-02-28 11:58:32 +1100 | [diff] [blame] | 814 | /* Setup error log interface */ |
| 815 | rc = opal_elog_init(); |
Vasant Hegde | 50bd615 | 2013-10-24 16:04:58 +0530 | [diff] [blame] | 816 | /* Setup code update interface */ |
| 817 | opal_flash_init(); |
Stewart Smith | c7e64b9 | 2014-03-03 10:25:42 +1100 | [diff] [blame] | 818 | /* Setup platform dump extract interface */ |
| 819 | opal_platform_dump_init(); |
Neelesh Gupta | 4029cd6 | 2014-03-07 11:02:09 +0530 | [diff] [blame] | 820 | /* Setup system parameters interface */ |
| 821 | opal_sys_param_init(); |
Joel Stanley | bfc3689 | 2014-04-01 14:28:19 +1030 | [diff] [blame] | 822 | /* Setup message log interface. */ |
| 823 | opal_msglog_init(); |
Vasant Hegde | 50bd615 | 2013-10-24 16:04:58 +0530 | [diff] [blame] | 824 | } |
Vasant Hegde | 6f68b5e | 2013-08-27 15:09:52 +0530 | [diff] [blame] | 825 | |
Benjamin Herrenschmidt | 3bf5756 | 2014-11-14 16:13:50 +1100 | [diff] [blame] | 826 | /* Initialize OPAL IPMI backend */ |
Jeremy Kerr | 608b286 | 2014-11-06 11:38:27 +0800 | [diff] [blame] | 827 | opal_ipmi_init(opal_node); |
| 828 | |
Benjamin Herrenschmidt | 14a43e6 | 2011-09-19 17:44:57 +0000 | [diff] [blame] | 829 | return 0; |
| 830 | } |
Michael Ellerman | b14726c | 2014-07-15 22:22:24 +1000 | [diff] [blame] | 831 | machine_subsys_initcall(powernv, opal_init); |
Benjamin Herrenschmidt | 73ed148 | 2013-05-10 16:59:18 +1000 | [diff] [blame] | 832 | |
| 833 | void opal_shutdown(void) |
| 834 | { |
| 835 | unsigned int i; |
Vasant Hegde | f7d98d1 | 2014-01-15 17:02:04 +1100 | [diff] [blame] | 836 | long rc = OPAL_BUSY; |
Benjamin Herrenschmidt | 73ed148 | 2013-05-10 16:59:18 +1000 | [diff] [blame] | 837 | |
Vasant Hegde | f7d98d1 | 2014-01-15 17:02:04 +1100 | [diff] [blame] | 838 | /* First free interrupts, which will also mask them */ |
Benjamin Herrenschmidt | 73ed148 | 2013-05-10 16:59:18 +1000 | [diff] [blame] | 839 | for (i = 0; i < opal_irq_count; i++) { |
| 840 | if (opal_irqs[i]) |
Anton Blanchard | b0d436c | 2013-08-07 02:01:24 +1000 | [diff] [blame] | 841 | free_irq(opal_irqs[i], NULL); |
Benjamin Herrenschmidt | 73ed148 | 2013-05-10 16:59:18 +1000 | [diff] [blame] | 842 | opal_irqs[i] = 0; |
| 843 | } |
Vasant Hegde | f7d98d1 | 2014-01-15 17:02:04 +1100 | [diff] [blame] | 844 | |
| 845 | /* |
| 846 | * Then sync with OPAL which ensure anything that can |
| 847 | * potentially write to our memory has completed such |
| 848 | * as an ongoing dump retrieval |
| 849 | */ |
| 850 | while (rc == OPAL_BUSY || rc == OPAL_BUSY_EVENT) { |
| 851 | rc = opal_sync_host_reboot(); |
| 852 | if (rc == OPAL_BUSY) |
| 853 | opal_poll_events(NULL); |
| 854 | else |
| 855 | mdelay(10); |
| 856 | } |
Vasant Hegde | b09c2ec | 2014-08-09 11:15:45 +0530 | [diff] [blame] | 857 | |
| 858 | /* Unregister memory dump region */ |
| 859 | opal_unregister_dump_region(OPAL_DUMP_REGION_LOG_BUF); |
Benjamin Herrenschmidt | 73ed148 | 2013-05-10 16:59:18 +1000 | [diff] [blame] | 860 | } |
Joel Stanley | e28b05e | 2014-04-01 14:28:20 +1030 | [diff] [blame] | 861 | |
| 862 | /* Export this so that test modules can use it */ |
| 863 | EXPORT_SYMBOL_GPL(opal_invalid_call); |
Jeremy Kerr | 608b286 | 2014-11-06 11:38:27 +0800 | [diff] [blame] | 864 | EXPORT_SYMBOL_GPL(opal_ipmi_send); |
| 865 | EXPORT_SYMBOL_GPL(opal_ipmi_recv); |
Anton Blanchard | 3441f04 | 2014-04-22 15:01:26 +1000 | [diff] [blame] | 866 | |
| 867 | /* Convert a region of vmalloc memory to an opal sg list */ |
| 868 | struct opal_sg_list *opal_vmalloc_to_sg_list(void *vmalloc_addr, |
| 869 | unsigned long vmalloc_size) |
| 870 | { |
| 871 | struct opal_sg_list *sg, *first = NULL; |
| 872 | unsigned long i = 0; |
| 873 | |
| 874 | sg = kzalloc(PAGE_SIZE, GFP_KERNEL); |
| 875 | if (!sg) |
| 876 | goto nomem; |
| 877 | |
| 878 | first = sg; |
| 879 | |
| 880 | while (vmalloc_size > 0) { |
| 881 | uint64_t data = vmalloc_to_pfn(vmalloc_addr) << PAGE_SHIFT; |
| 882 | uint64_t length = min(vmalloc_size, PAGE_SIZE); |
| 883 | |
| 884 | sg->entry[i].data = cpu_to_be64(data); |
| 885 | sg->entry[i].length = cpu_to_be64(length); |
| 886 | i++; |
| 887 | |
| 888 | if (i >= SG_ENTRIES_PER_NODE) { |
| 889 | struct opal_sg_list *next; |
| 890 | |
| 891 | next = kzalloc(PAGE_SIZE, GFP_KERNEL); |
| 892 | if (!next) |
| 893 | goto nomem; |
| 894 | |
| 895 | sg->length = cpu_to_be64( |
| 896 | i * sizeof(struct opal_sg_entry) + 16); |
| 897 | i = 0; |
| 898 | sg->next = cpu_to_be64(__pa(next)); |
| 899 | sg = next; |
| 900 | } |
| 901 | |
| 902 | vmalloc_addr += length; |
| 903 | vmalloc_size -= length; |
| 904 | } |
| 905 | |
| 906 | sg->length = cpu_to_be64(i * sizeof(struct opal_sg_entry) + 16); |
| 907 | |
| 908 | return first; |
| 909 | |
| 910 | nomem: |
| 911 | pr_err("%s : Failed to allocate memory\n", __func__); |
| 912 | opal_free_sg_list(first); |
| 913 | return NULL; |
| 914 | } |
| 915 | |
| 916 | void opal_free_sg_list(struct opal_sg_list *sg) |
| 917 | { |
| 918 | while (sg) { |
| 919 | uint64_t next = be64_to_cpu(sg->next); |
| 920 | |
| 921 | kfree(sg); |
| 922 | |
| 923 | if (next) |
| 924 | sg = __va(next); |
| 925 | else |
| 926 | sg = NULL; |
| 927 | } |
| 928 | } |
Neelesh Gupta | 16b1d26 | 2014-10-14 14:08:36 +0530 | [diff] [blame] | 929 | |
| 930 | EXPORT_SYMBOL_GPL(opal_poll_events); |
| 931 | EXPORT_SYMBOL_GPL(opal_rtc_read); |
| 932 | EXPORT_SYMBOL_GPL(opal_rtc_write); |
| 933 | EXPORT_SYMBOL_GPL(opal_tpo_read); |
| 934 | EXPORT_SYMBOL_GPL(opal_tpo_write); |
Neelesh Gupta | 4708345 | 2014-12-13 23:31:05 +0530 | [diff] [blame] | 935 | EXPORT_SYMBOL_GPL(opal_i2c_request); |