blob: 8272e2db9f87925e98853b0fcc17e8e3b81dbdd3 [file] [log] [blame]
Hou Zhiqiang45684ae2016-06-28 20:18:16 +08001/*
2 * Copyright 2016 NXP Semiconductor, Inc.
3 *
4 * SPDX-License-Identifier: GPL-2.0+
5 */
6
7#include <common.h>
Masahiro Yamadab08c8c42018-03-05 01:20:11 +09008#include <linux/libfdt.h>
Hou Zhiqiang45684ae2016-06-28 20:18:16 +08009#include <fdt_support.h>
10#include <linux/sizes.h>
11#include <linux/kernel.h>
12#include <asm/psci.h>
13#ifdef CONFIG_ARMV8_SEC_FIRMWARE_SUPPORT
14#include <asm/armv8/sec_firmware.h>
15#endif
16
17int fdt_psci(void *fdt)
18{
macro.wave.z@gmail.com9a561752016-12-08 11:58:25 +080019#if defined(CONFIG_ARMV7_PSCI) || defined(CONFIG_ARMV8_PSCI) || \
Hou Zhiqiangdaa92642017-01-16 17:31:48 +080020 defined(CONFIG_SEC_FIRMWARE_ARMV8_PSCI)
Hou Zhiqiang45684ae2016-06-28 20:18:16 +080021 int nodeoff;
22 unsigned int psci_ver = 0;
Hou Zhiqiang45684ae2016-06-28 20:18:16 +080023 int tmp;
24
25 nodeoff = fdt_path_offset(fdt, "/cpus");
26 if (nodeoff < 0) {
27 printf("couldn't find /cpus\n");
28 return nodeoff;
29 }
30
31 /* add 'enable-method = "psci"' to each cpu node */
32 for (tmp = fdt_first_subnode(fdt, nodeoff);
33 tmp >= 0;
34 tmp = fdt_next_subnode(fdt, tmp)) {
35 const struct fdt_property *prop;
36 int len;
37
38 prop = fdt_get_property(fdt, tmp, "device_type", &len);
39 if (!prop)
40 continue;
41 if (len < 4)
42 continue;
43 if (strcmp(prop->data, "cpu"))
44 continue;
45
46 /*
47 * Not checking rv here, our approach is to skip over errors in
48 * individual cpu nodes, hopefully some of the nodes are
49 * processed correctly and those will boot
50 */
51 fdt_setprop_string(fdt, tmp, "enable-method", "psci");
52 }
53
Hou Zhiqiang45684ae2016-06-28 20:18:16 +080054 nodeoff = fdt_path_offset(fdt, "/psci");
55 if (nodeoff >= 0)
56 goto init_psci_node;
57
Hou Zhiqiang45684ae2016-06-28 20:18:16 +080058 nodeoff = fdt_path_offset(fdt, "/");
59 if (nodeoff < 0)
60 return nodeoff;
61
62 nodeoff = fdt_add_subnode(fdt, nodeoff, "psci");
63 if (nodeoff < 0)
64 return nodeoff;
65
66init_psci_node:
67#ifdef CONFIG_ARMV8_SEC_FIRMWARE_SUPPORT
68 psci_ver = sec_firmware_support_psci_version();
macro.wave.z@gmail.com9a561752016-12-08 11:58:25 +080069#elif defined(CONFIG_ARMV7_PSCI_1_0) || defined(CONFIG_ARMV8_PSCI)
Hou Zhiqiangbded2182016-07-29 18:26:37 +080070 psci_ver = ARM_PSCI_VER_1_0;
Hou Zhiqiang45684ae2016-06-28 20:18:16 +080071#endif
Andre Heider678382c2018-02-09 08:10:22 +010072 if (psci_ver >= ARM_PSCI_VER_1_0) {
Hou Zhiqiang2c774162016-07-29 18:26:36 +080073 tmp = fdt_setprop_string(fdt, nodeoff,
74 "compatible", "arm,psci-1.0");
75 if (tmp)
76 return tmp;
Andre Heider678382c2018-02-09 08:10:22 +010077 }
78
79 if (psci_ver >= ARM_PSCI_VER_0_2) {
Hou Zhiqiang2c774162016-07-29 18:26:36 +080080 tmp = fdt_appendprop_string(fdt, nodeoff,
81 "compatible", "arm,psci-0.2");
82 if (tmp)
83 return tmp;
Andre Heider678382c2018-02-09 08:10:22 +010084 }
85
86#ifndef CONFIG_ARMV8_SEC_FIRMWARE_SUPPORT
Hou Zhiqiang2c774162016-07-29 18:26:36 +080087 /*
88 * The Secure firmware framework isn't able to support PSCI version 0.1.
89 */
Andre Heider678382c2018-02-09 08:10:22 +010090 if (psci_ver < ARM_PSCI_VER_0_2) {
Hou Zhiqiang2c774162016-07-29 18:26:36 +080091 tmp = fdt_appendprop_string(fdt, nodeoff,
92 "compatible", "arm,psci");
93 if (tmp)
94 return tmp;
95 tmp = fdt_setprop_u32(fdt, nodeoff, "cpu_suspend",
96 ARM_PSCI_FN_CPU_SUSPEND);
97 if (tmp)
98 return tmp;
99 tmp = fdt_setprop_u32(fdt, nodeoff, "cpu_off",
100 ARM_PSCI_FN_CPU_OFF);
101 if (tmp)
102 return tmp;
103 tmp = fdt_setprop_u32(fdt, nodeoff, "cpu_on",
104 ARM_PSCI_FN_CPU_ON);
105 if (tmp)
106 return tmp;
107 tmp = fdt_setprop_u32(fdt, nodeoff, "migrate",
108 ARM_PSCI_FN_MIGRATE);
109 if (tmp)
110 return tmp;
Hou Zhiqiang45684ae2016-06-28 20:18:16 +0800111 }
Andre Heider678382c2018-02-09 08:10:22 +0100112#endif
Hou Zhiqiang45684ae2016-06-28 20:18:16 +0800113
Hou Zhiqiang45684ae2016-06-28 20:18:16 +0800114 tmp = fdt_setprop_string(fdt, nodeoff, "method", "smc");
115 if (tmp)
116 return tmp;
117
Hou Zhiqiang45684ae2016-06-28 20:18:16 +0800118#endif
119 return 0;
120}