riscv: Clean up initialization in Andes PLIC
This merges the PLIC initialization code from two functions into one. Signed-off-by: Sean Anderson <seanga2@gmail.com> Reviewed-by: Bin Meng <bin.meng@windriver.com>
This commit is contained in:
@@ -41,53 +41,45 @@ static int enable_ipi(int hart)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int init_plic(void)
|
int riscv_init_ipi(void)
|
||||||
{
|
{
|
||||||
struct udevice *dev;
|
|
||||||
ofnode node;
|
|
||||||
int ret;
|
int ret;
|
||||||
|
long *base = syscon_get_first_range(RISCV_SYSCON_PLIC);
|
||||||
|
ofnode node;
|
||||||
|
struct udevice *dev;
|
||||||
u32 reg;
|
u32 reg;
|
||||||
|
|
||||||
|
if (IS_ERR(base))
|
||||||
|
return PTR_ERR(base);
|
||||||
|
gd->arch.plic = base;
|
||||||
|
|
||||||
ret = uclass_find_first_device(UCLASS_CPU, &dev);
|
ret = uclass_find_first_device(UCLASS_CPU, &dev);
|
||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
else if (!dev)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
if (dev) {
|
ofnode_for_each_subnode(node, dev_ofnode(dev->parent)) {
|
||||||
ofnode_for_each_subnode(node, dev_ofnode(dev->parent)) {
|
const char *device_type;
|
||||||
const char *device_type;
|
|
||||||
|
|
||||||
device_type = ofnode_read_string(node, "device_type");
|
device_type = ofnode_read_string(node, "device_type");
|
||||||
if (!device_type)
|
if (!device_type)
|
||||||
continue;
|
continue;
|
||||||
|
|
||||||
if (strcmp(device_type, "cpu"))
|
if (strcmp(device_type, "cpu"))
|
||||||
continue;
|
continue;
|
||||||
|
|
||||||
/* skip if hart is marked as not available */
|
/* skip if hart is marked as not available */
|
||||||
if (!ofnode_is_available(node))
|
if (!ofnode_is_available(node))
|
||||||
continue;
|
continue;
|
||||||
|
|
||||||
/* read hart ID of CPU */
|
/* read hart ID of CPU */
|
||||||
ret = ofnode_read_u32(node, "reg", ®);
|
ret = ofnode_read_u32(node, "reg", ®);
|
||||||
if (ret == 0)
|
if (ret == 0)
|
||||||
enable_ipi(reg);
|
enable_ipi(reg);
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return -ENODEV;
|
return 0;
|
||||||
}
|
|
||||||
|
|
||||||
int riscv_init_ipi(void)
|
|
||||||
{
|
|
||||||
long *ret = syscon_get_first_range(RISCV_SYSCON_PLIC);
|
|
||||||
|
|
||||||
if (IS_ERR(ret))
|
|
||||||
return PTR_ERR(ret);
|
|
||||||
gd->arch.plic = ret;
|
|
||||||
|
|
||||||
return init_plic();
|
|
||||||
}
|
}
|
||||||
|
|
||||||
int riscv_send_ipi(int hart)
|
int riscv_send_ipi(int hart)
|
||||||
|
|||||||
Reference in New Issue
Block a user