Angel Pons | c74dae9 | 2020-04-02 23:48:16 +0200 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
Kyösti Mälkki | c33f1e9 | 2012-08-07 17:12:11 +0300 | [diff] [blame] | 2 | |
| 3 | #include <device/device.h> |
| 4 | #include <console/console.h> |
Elyes Haouas | 04c3b5a | 2022-10-07 10:08:05 +0200 | [diff] [blame] | 5 | #include <stddef.h> |
Kyösti Mälkki | c33f1e9 | 2012-08-07 17:12:11 +0300 | [diff] [blame] | 6 | |
Elyes HAOUAS | 8cf8a63 | 2019-06-09 10:23:25 +0200 | [diff] [blame] | 7 | struct device *add_cpu_device(struct bus *cpu_bus, unsigned int apic_id, |
Elyes HAOUAS | e348066 | 2018-05-06 20:32:23 +0200 | [diff] [blame] | 8 | int enabled) |
Kyösti Mälkki | c33f1e9 | 2012-08-07 17:12:11 +0300 | [diff] [blame] | 9 | { |
| 10 | struct device_path cpu_path; |
Elyes HAOUAS | e348066 | 2018-05-06 20:32:23 +0200 | [diff] [blame] | 11 | struct device *cpu; |
Kyösti Mälkki | c33f1e9 | 2012-08-07 17:12:11 +0300 | [diff] [blame] | 12 | |
Elyes HAOUAS | fa640a2 | 2016-07-28 21:31:40 +0200 | [diff] [blame] | 13 | /* Build the CPU device path */ |
Kyösti Mälkki | c33f1e9 | 2012-08-07 17:12:11 +0300 | [diff] [blame] | 14 | cpu_path.type = DEVICE_PATH_APIC; |
| 15 | cpu_path.apic.apic_id = apic_id; |
| 16 | |
| 17 | /* Update CPU in devicetree. */ |
| 18 | if (enabled) |
| 19 | cpu = alloc_find_dev(cpu_bus, &cpu_path); |
| 20 | else |
| 21 | cpu = find_dev_path(cpu_bus, &cpu_path); |
| 22 | if (!cpu) |
| 23 | return NULL; |
| 24 | |
| 25 | cpu->enabled = enabled; |
| 26 | printk(BIOS_DEBUG, "CPU: %s %s\n", |
| 27 | dev_path(cpu), cpu->enabled?"enabled":"disabled"); |
| 28 | |
| 29 | return cpu; |
| 30 | } |
| 31 | |
Elyes HAOUAS | 8cf8a63 | 2019-06-09 10:23:25 +0200 | [diff] [blame] | 32 | void set_cpu_topology(struct device *cpu, unsigned int node, |
| 33 | unsigned int package, unsigned int core, |
| 34 | unsigned int thread) |
Kyösti Mälkki | c33f1e9 | 2012-08-07 17:12:11 +0300 | [diff] [blame] | 35 | { |
| 36 | cpu->path.apic.node_id = node; |
| 37 | cpu->path.apic.package_id = package; |
| 38 | cpu->path.apic.core_id = core; |
| 39 | cpu->path.apic.thread_id = thread; |
| 40 | } |