1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
|
/* SPDX-License-Identifier: GPL-2.0-only */
#include <stdint.h>
#include <stdlib.h>
#include <string.h>
#include <console/console.h>
#include <soc/otp.h>
#include <soc/sdram.h>
#include <cbfs.h>
#include <device_tree.h>
#include <bootstate.h>
#include <mcall.h>
static void do_fixup_mac(struct device_tree_node *node)
{
uint32_t serial = otp_read_serial();
static unsigned char mac[6] = { 0x70, 0xb3, 0xd5, 0x92, 0xf0, 0x00 };
if (serial != ~0) {
mac[5] |= (serial >> 0) & 0xff;
mac[4] |= (serial >> 8) & 0xff;
mac[3] |= (serial >> 16) & 0xff;
}
dt_add_bin_prop(node, "local-mac-address", mac, 6);
}
static void fixup_mac(struct device_tree_node *parent)
{
struct device_tree_property *prop;
const char *name = "local-mac-address";
list_for_each(prop, parent->properties, list_node) {
if (!strcmp(name, prop->prop.name))
do_fixup_mac(parent);
}
struct device_tree_node *child;
list_for_each(child, parent->children, list_node) {
fixup_mac(child);
}
}
static void do_fixup_memory(struct device_tree_node *node)
{
u64 addrs[1], sizes[1];
addrs[0] = 0x80000000;
sizes[0] = sdram_size();
dt_add_reg_prop(node, addrs, sizes, 1, 2, 2);
}
static void fixup_memory(struct device_tree_node *parent)
{
struct device_tree_property *prop;
const char *name = "device_type";
const char *value = "memory";
list_for_each(prop, parent->properties, list_node) {
if (!strcmp(name, prop->prop.name)) {
if (!strcmp(value, (char *)prop->prop.data))
do_fixup_memory(parent);
}
}
struct device_tree_node *child;
list_for_each(child, parent->children, list_node) {
fixup_memory(child);
}
}
static void fixup_fdt(void *unused)
{
printk(BIOS_DEBUG, "fix up FDT\n");
void *fdt_rom;
struct device_tree *tree;
/* load flat dt from cbfs */
fdt_rom = cbfs_map("fallback/DTB", NULL);
if (fdt_rom == NULL) {
printk(BIOS_ERR, "Unable to load fallback/DTB from CBFS\n");
return;
}
/* Expand DT into a tree */
tree = fdt_unflatten(fdt_rom);
/* fixup tree */
fixup_mac(tree->root);
fixup_memory(tree->root);
/* convert the tree to a flat dt */
void *dt = malloc(dt_flat_size(tree));
if (dt == NULL) {
printk(BIOS_ERR, "Unable to allocate memory for flat device tree\n");
return;
}
dt_flatten(tree, dt);
/* update HLS */
for (int i = 0; i < CONFIG_MAX_CPUS; i++)
OTHER_HLS(i)->fdt = dt;
}
BOOT_STATE_INIT_ENTRY(BS_WRITE_TABLES, BS_ON_EXIT, fixup_fdt, NULL);
|
