David Brazdil | 0f672f6 | 2019-12-10 10:32:29 +0000 | [diff] [blame^] | 1 | // SPDX-License-Identifier: GPL-2.0-only |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 2 | /* |
| 3 | * ePAPR para-virtualization support. |
| 4 | * |
Andrew Scull | b4b6d4a | 2019-01-02 15:54:55 +0000 | [diff] [blame] | 5 | * Copyright (C) 2012 Freescale Semiconductor, Inc. |
| 6 | */ |
| 7 | |
| 8 | #include <linux/of.h> |
| 9 | #include <linux/of_fdt.h> |
| 10 | #include <asm/epapr_hcalls.h> |
| 11 | #include <asm/cacheflush.h> |
| 12 | #include <asm/code-patching.h> |
| 13 | #include <asm/machdep.h> |
| 14 | |
| 15 | #if !defined(CONFIG_64BIT) || defined(CONFIG_PPC_BOOK3E_64) |
| 16 | extern void epapr_ev_idle(void); |
| 17 | extern u32 epapr_ev_idle_start[]; |
| 18 | #endif |
| 19 | |
| 20 | bool epapr_paravirt_enabled; |
| 21 | static bool __maybe_unused epapr_has_idle; |
| 22 | |
| 23 | static int __init early_init_dt_scan_epapr(unsigned long node, |
| 24 | const char *uname, |
| 25 | int depth, void *data) |
| 26 | { |
| 27 | const u32 *insts; |
| 28 | int len; |
| 29 | int i; |
| 30 | |
| 31 | insts = of_get_flat_dt_prop(node, "hcall-instructions", &len); |
| 32 | if (!insts) |
| 33 | return 0; |
| 34 | |
| 35 | if (len % 4 || len > (4 * 4)) |
| 36 | return -1; |
| 37 | |
| 38 | for (i = 0; i < (len / 4); i++) { |
| 39 | u32 inst = be32_to_cpu(insts[i]); |
| 40 | patch_instruction(epapr_hypercall_start + i, inst); |
| 41 | #if !defined(CONFIG_64BIT) || defined(CONFIG_PPC_BOOK3E_64) |
| 42 | patch_instruction(epapr_ev_idle_start + i, inst); |
| 43 | #endif |
| 44 | } |
| 45 | |
| 46 | #if !defined(CONFIG_64BIT) || defined(CONFIG_PPC_BOOK3E_64) |
| 47 | if (of_get_flat_dt_prop(node, "has-idle", NULL)) |
| 48 | epapr_has_idle = true; |
| 49 | #endif |
| 50 | |
| 51 | epapr_paravirt_enabled = true; |
| 52 | |
| 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 | |
| 60 | return 0; |
| 61 | } |
| 62 | |
| 63 | static int __init epapr_idle_init(void) |
| 64 | { |
| 65 | #if !defined(CONFIG_64BIT) || defined(CONFIG_PPC_BOOK3E_64) |
| 66 | if (epapr_has_idle) |
| 67 | ppc_md.power_save = epapr_ev_idle; |
| 68 | #endif |
| 69 | |
| 70 | return 0; |
| 71 | } |
| 72 | |
| 73 | postcore_initcall(epapr_idle_init); |