| York Sun | 56cc3db | 2014-09-08 12:20:00 -0700 | [diff] [blame^] | 1 | /* |
| 2 | * Copyright 2014 Freescale Semiconductor, Inc. |
| 3 | * |
| 4 | * SPDX-License-Identifier: GPL-2.0+ |
| 5 | */ |
| 6 | |
| 7 | #include <common.h> |
| 8 | #include <libfdt.h> |
| 9 | #include <fdt_support.h> |
| 10 | #include "mp.h" |
| 11 | |
| 12 | #ifdef CONFIG_MP |
| 13 | void ft_fixup_cpu(void *blob) |
| 14 | { |
| 15 | int off; |
| 16 | __maybe_unused u64 spin_tbl_addr = (u64)get_spin_tbl_addr(); |
| 17 | fdt32_t *reg; |
| 18 | int addr_cells; |
| 19 | u64 val; |
| 20 | size_t *boot_code_size = &(__secondary_boot_code_size); |
| 21 | |
| 22 | off = fdt_path_offset(blob, "/cpus"); |
| 23 | if (off < 0) { |
| 24 | puts("couldn't find /cpus node\n"); |
| 25 | return; |
| 26 | } |
| 27 | of_bus_default_count_cells(blob, off, &addr_cells, NULL); |
| 28 | |
| 29 | off = fdt_node_offset_by_prop_value(blob, -1, "device_type", "cpu", 4); |
| 30 | while (off != -FDT_ERR_NOTFOUND) { |
| 31 | reg = (fdt32_t *)fdt_getprop(blob, off, "reg", 0); |
| 32 | if (reg) { |
| 33 | val = spin_tbl_addr; |
| 34 | val += id_to_core(of_read_number(reg, addr_cells)) |
| 35 | * SPIN_TABLE_ELEM_SIZE; |
| 36 | val = cpu_to_fdt64(val); |
| 37 | fdt_setprop_string(blob, off, "enable-method", |
| 38 | "spin-table"); |
| 39 | fdt_setprop(blob, off, "cpu-release-addr", |
| 40 | &val, sizeof(val)); |
| 41 | } else { |
| 42 | puts("Warning: found cpu node without reg property\n"); |
| 43 | } |
| 44 | off = fdt_node_offset_by_prop_value(blob, off, "device_type", |
| 45 | "cpu", 4); |
| 46 | } |
| 47 | |
| 48 | fdt_add_mem_rsv(blob, (uintptr_t)&secondary_boot_code, |
| 49 | *boot_code_size); |
| 50 | } |
| 51 | #endif |
| 52 | |
| 53 | void ft_cpu_setup(void *blob, bd_t *bd) |
| 54 | { |
| 55 | #ifdef CONFIG_MP |
| 56 | ft_fixup_cpu(blob); |
| 57 | #endif |
| 58 | } |