1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Copyright (C) 2016 Socionext Inc.
3*4882a593Smuzhiyun * Author: Masahiro Yamada <yamada.masahiro@socionext.com>
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <common.h>
9*4882a593Smuzhiyun #include <linux/libfdt.h>
10*4882a593Smuzhiyun #include <asm/spin_table.h>
11*4882a593Smuzhiyun
spin_table_update_dt(void * fdt)12*4882a593Smuzhiyun int spin_table_update_dt(void *fdt)
13*4882a593Smuzhiyun {
14*4882a593Smuzhiyun int cpus_offset, offset;
15*4882a593Smuzhiyun const char *prop;
16*4882a593Smuzhiyun int ret;
17*4882a593Smuzhiyun unsigned long rsv_addr = (unsigned long)&spin_table_reserve_begin;
18*4882a593Smuzhiyun unsigned long rsv_size = &spin_table_reserve_end -
19*4882a593Smuzhiyun &spin_table_reserve_begin;
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun cpus_offset = fdt_path_offset(fdt, "/cpus");
22*4882a593Smuzhiyun if (cpus_offset < 0)
23*4882a593Smuzhiyun return -ENODEV;
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun for (offset = fdt_first_subnode(fdt, cpus_offset);
26*4882a593Smuzhiyun offset >= 0;
27*4882a593Smuzhiyun offset = fdt_next_subnode(fdt, offset)) {
28*4882a593Smuzhiyun prop = fdt_getprop(fdt, offset, "device_type", NULL);
29*4882a593Smuzhiyun if (!prop || strcmp(prop, "cpu"))
30*4882a593Smuzhiyun continue;
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun /*
33*4882a593Smuzhiyun * In the first loop, we check if every CPU node specifies
34*4882a593Smuzhiyun * spin-table. Otherwise, just return successfully to not
35*4882a593Smuzhiyun * disturb other methods, like psci.
36*4882a593Smuzhiyun */
37*4882a593Smuzhiyun prop = fdt_getprop(fdt, offset, "enable-method", NULL);
38*4882a593Smuzhiyun if (!prop || strcmp(prop, "spin-table"))
39*4882a593Smuzhiyun return 0;
40*4882a593Smuzhiyun }
41*4882a593Smuzhiyun
42*4882a593Smuzhiyun for (offset = fdt_first_subnode(fdt, cpus_offset);
43*4882a593Smuzhiyun offset >= 0;
44*4882a593Smuzhiyun offset = fdt_next_subnode(fdt, offset)) {
45*4882a593Smuzhiyun prop = fdt_getprop(fdt, offset, "device_type", NULL);
46*4882a593Smuzhiyun if (!prop || strcmp(prop, "cpu"))
47*4882a593Smuzhiyun continue;
48*4882a593Smuzhiyun
49*4882a593Smuzhiyun ret = fdt_setprop_u64(fdt, offset, "cpu-release-addr",
50*4882a593Smuzhiyun (unsigned long)&spin_table_cpu_release_addr);
51*4882a593Smuzhiyun if (ret)
52*4882a593Smuzhiyun return -ENOSPC;
53*4882a593Smuzhiyun }
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun ret = fdt_add_mem_rsv(fdt, rsv_addr, rsv_size);
56*4882a593Smuzhiyun if (ret)
57*4882a593Smuzhiyun return -ENOSPC;
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun printf(" Reserved memory region for spin-table: addr=%lx size=%lx\n",
60*4882a593Smuzhiyun rsv_addr, rsv_size);
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun return 0;
63*4882a593Smuzhiyun }
64