Thomas Gleixner | d94d71c | 2019-05-29 07:12:40 -0700 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0-only |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 2 | /* |
| 3 | * ePAPR para-virtualization support. |
| 4 | * |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 5 | * Copyright (C) 2012 Freescale Semiconductor, Inc. |
| 6 | */ |
| 7 | |
| 8 | #include <linux/of.h> |
Rob Herring | 26a2056 | 2013-09-26 07:40:04 -0500 | [diff] [blame] | 9 | #include <linux/of_fdt.h> |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 10 | #include <asm/epapr_hcalls.h> |
| 11 | #include <asm/cacheflush.h> |
| 12 | #include <asm/code-patching.h> |
Liu Yu-B13201 | 2f979de | 2012-07-03 05:48:53 +0000 | [diff] [blame] | 13 | #include <asm/machdep.h> |
| 14 | |
Stuart Yoder | f9294e9 | 2013-03-22 09:12:13 +0000 | [diff] [blame] | 15 | #if !defined(CONFIG_64BIT) || defined(CONFIG_PPC_BOOK3E_64) |
Liu Yu-B13201 | 2f979de | 2012-07-03 05:48:53 +0000 | [diff] [blame] | 16 | extern void epapr_ev_idle(void); |
| 17 | extern u32 epapr_ev_idle_start[]; |
Stuart Yoder | f9294e9 | 2013-03-22 09:12:13 +0000 | [diff] [blame] | 18 | #endif |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 19 | |
| 20 | bool epapr_paravirt_enabled; |
Scott Wood | 8067bd8 | 2014-05-15 11:28:26 -0500 | [diff] [blame] | 21 | static bool __maybe_unused epapr_has_idle; |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 22 | |
Laurentiu TUDOR | 4e21b94 | 2013-07-03 17:13:15 +0300 | [diff] [blame] | 23 | static int __init early_init_dt_scan_epapr(unsigned long node, |
| 24 | const char *uname, |
| 25 | int depth, void *data) |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 26 | { |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 27 | const u32 *insts; |
Rob Herring | 9d0c4df | 2014-04-01 23:49:03 -0500 | [diff] [blame] | 28 | int len; |
Laurentiu TUDOR | 4e21b94 | 2013-07-03 17:13:15 +0300 | [diff] [blame] | 29 | int i; |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 30 | |
Laurentiu TUDOR | 4e21b94 | 2013-07-03 17:13:15 +0300 | [diff] [blame] | 31 | insts = of_get_flat_dt_prop(node, "hcall-instructions", &len); |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 32 | if (!insts) |
Laurentiu TUDOR | 4e21b94 | 2013-07-03 17:13:15 +0300 | [diff] [blame] | 33 | return 0; |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 34 | |
| 35 | if (len % 4 || len > (4 * 4)) |
Laurentiu TUDOR | 4e21b94 | 2013-07-03 17:13:15 +0300 | [diff] [blame] | 36 | return -1; |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 37 | |
Liu Yu-B13201 | 2f979de | 2012-07-03 05:48:53 +0000 | [diff] [blame] | 38 | for (i = 0; i < (len / 4); i++) { |
Alexander Graf | 235959b | 2014-05-13 16:44:09 +0200 | [diff] [blame] | 39 | u32 inst = be32_to_cpu(insts[i]); |
| 40 | patch_instruction(epapr_hypercall_start + i, inst); |
Stuart Yoder | f9294e9 | 2013-03-22 09:12:13 +0000 | [diff] [blame] | 41 | #if !defined(CONFIG_64BIT) || defined(CONFIG_PPC_BOOK3E_64) |
Alexander Graf | 235959b | 2014-05-13 16:44:09 +0200 | [diff] [blame] | 42 | patch_instruction(epapr_ev_idle_start + i, inst); |
Stuart Yoder | f9294e9 | 2013-03-22 09:12:13 +0000 | [diff] [blame] | 43 | #endif |
Liu Yu-B13201 | 2f979de | 2012-07-03 05:48:53 +0000 | [diff] [blame] | 44 | } |
| 45 | |
Stuart Yoder | f9294e9 | 2013-03-22 09:12:13 +0000 | [diff] [blame] | 46 | #if !defined(CONFIG_64BIT) || defined(CONFIG_PPC_BOOK3E_64) |
Laurentiu TUDOR | 4e21b94 | 2013-07-03 17:13:15 +0300 | [diff] [blame] | 47 | if (of_get_flat_dt_prop(node, "has-idle", NULL)) |
Stuart Yoder | 83e267d | 2014-04-30 18:34:23 -0500 | [diff] [blame] | 48 | epapr_has_idle = true; |
Stuart Yoder | f9294e9 | 2013-03-22 09:12:13 +0000 | [diff] [blame] | 49 | #endif |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 50 | |
| 51 | epapr_paravirt_enabled = true; |
| 52 | |
Laurentiu TUDOR | 4e21b94 | 2013-07-03 17:13:15 +0300 | [diff] [blame] | 53 | return 1; |
| 54 | } |
| 55 | |
| 56 | int __init epapr_paravirt_early_init(void) |
| 57 | { |
| 58 | of_scan_flat_dt(early_init_dt_scan_epapr, NULL); |
| 59 | |
Liu Yu-B13201 | 2e1ae9c | 2012-03-15 10:52:13 +0000 | [diff] [blame] | 60 | return 0; |
| 61 | } |
| 62 | |
Stuart Yoder | 83e267d | 2014-04-30 18:34:23 -0500 | [diff] [blame] | 63 | static int __init epapr_idle_init(void) |
| 64 | { |
Scott Wood | 440d74d | 2014-05-12 10:05:19 -0500 | [diff] [blame] | 65 | #if !defined(CONFIG_64BIT) || defined(CONFIG_PPC_BOOK3E_64) |
Stuart Yoder | 83e267d | 2014-04-30 18:34:23 -0500 | [diff] [blame] | 66 | if (epapr_has_idle) |
| 67 | ppc_md.power_save = epapr_ev_idle; |
Scott Wood | 440d74d | 2014-05-12 10:05:19 -0500 | [diff] [blame] | 68 | #endif |
Stuart Yoder | 83e267d | 2014-04-30 18:34:23 -0500 | [diff] [blame] | 69 | |
| 70 | return 0; |
| 71 | } |
| 72 | |
| 73 | postcore_initcall(epapr_idle_init); |