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