lby/lk
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

[lib][fdtwalk] add code to skip a cpu if disabled

Browse Source 
Some RISC-V cpus come up disabled, skip enumerating them.
This commit is contained in:
Travis Geiselbrecht
2023-07-05 23:30:52 -07:00
parent 284f83af11
commit 6b7d0ab627
1 changed files with 22 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

24
lib/fdtwalk/fdtwalk.c
View File

@@ -77,6 +77,21 @@ static status_t read_base_len_pair(const uint8_t *prop_ptr, size_t prop_len,
return NO_ERROR;
}
// returns true or false if a particular property is a particular value
static bool check_prop_is_val_string(const void *fdt, int offset, const char *prop, const char *val) {
int lenp;
const uint8_t *prop_ptr = fdt_getprop(fdt, offset, prop, &lenp);
if (!prop_ptr || lenp <= 0) {
return false;
}
if (strncmp(val, (const char *)prop_ptr, strlen(val)) == 0) {
return true;
}
return false;
}
status_t fdt_walk(const void *fdt, const struct fdt_walk_callbacks *cb) {
int err = fdt_check_header(fdt);
if (err != 0) {
@@ -202,8 +217,13 @@ status_t fdt_walk(const void *fdt, const struct fdt_walk_callbacks *cb) {
PANIC_UNIMPLEMENTED;
}
LTRACEF("calling cpu callback with id %#x\n", id);
cb->cpu(id, cb->cpucookie);
// is it disabled?
if (check_prop_is_val_string(fdt, offset, "status", "disabled")) {
LTRACEF("cpu id %#x is disabled, skipping...\n", id);
} else {
LTRACEF("calling cpu callback with id %#x\n", id);
cb->cpu(id, cb->cpucookie);
}
}
}