static struct virtio_device *virtio_mmio_dt_bind(u32 devid)
{
struct virtio_mmio_device *vm_dev;
struct dt_device dt_dev;
struct dt_bus dt_bus;
struct vm_dt_info info;
int node;
if (!dt_available())
return NULL;
dt_bus_init_defaults(&dt_bus);
dt_bus.match = vm_dt_match;
info.devid = devid;
dt_device_init(&dt_dev, &dt_bus, &info);
node = dt_device_find_compatible(&dt_dev, "virtio,mmio");
assert(node >= 0 || node == -FDT_ERR_NOTFOUND);
if (node == -FDT_ERR_NOTFOUND)
return NULL;
vm_dev = calloc(1, sizeof(*vm_dev));
if (!vm_dev)
return NULL;
vm_dev->base = info.base;
vm_device_init(vm_dev);
return &vm_dev->vdev;
}
void rtas_init(void)
{
bool broken_sc1 = hcall_have_broken_sc1();
int node = rtas_node(), len, words, i;
const struct fdt_property *prop;
u32 *data, *insns;
if (!dt_available()) {
printf("%s: No device tree!\n", __func__);
abort();
}
prop = fdt_get_property(dt_fdt(), node,
"linux,rtas-entry", &len);
if (!prop) {
printf("%s: /rtas/linux,rtas-entry: %s\n",
__func__, fdt_strerror(len));
abort();
}
data = (u32 *)prop->data;
rtas_entry = (unsigned long)fdt32_to_cpu(*data);
insns = (u32 *)rtas_entry;
prop = fdt_get_property(dt_fdt(), node, "rtas-size", &len);
if (!prop) {
printf("%s: /rtas/rtas-size: %s\n",
__func__, fdt_strerror(len));
abort();
}
data = (u32 *)prop->data;
words = (int)fdt32_to_cpu(*data)/4;
for (i = 0; i < words; ++i) {
if (broken_sc1 && insns[i] == cpu_to_be32(SC1))
insns[i] = cpu_to_be32(SC1_REPLACEMENT);
}
}
