ref(core/remio): added vm_init_remio_dev function

Signed-off-by: João Peixoto <[email protected]>

Author: joaopeixoto13

src/core/vm.c

@@ -228,6 +228,44 @@ static void vm_init_dev(struct vm* vm, const struct vm_config* vm_config)
     }
 }
 
+static void vm_init_remio_dev(struct remio_dev* remio_dev, struct vm* vm)
+{
+    struct shmem* shmem = shmem_get(remio_dev->shmem.shmem_id);
+    if (shmem == NULL) {
+        ERROR("Invalid shmem id (%d) in the Remote I/O device (%d) configuration",
+            remio_dev->shmem.shmem_id, remio_dev->id);
+    }
+    size_t shmem_size = remio_dev->shmem.size;
+    if (shmem_size > shmem->size) {
+        shmem_size = shmem->size;
+        WARNING("Trying to map region to smaller shared memory. Truncated");
+    }
+    spin_lock(&shmem->lock);
+    shmem->cpu_masters |= (1UL << cpu()->id);
+    spin_unlock(&shmem->lock);
+
+    struct vm_mem_region reg = {
+        .base = remio_dev->shmem.base,
+        .size = shmem_size,
+        .place_phys = true,
+        .phys = shmem->phys,
+        .colors = shmem->colors,
+    };
+
+    vm_map_mem_region(vm, &reg);
+
+    if (remio_dev->type == REMIO_DEV_FRONTEND) {
+        struct emul_mem* emu = objpool_alloc(&emul_cache);
+        if (emu == NULL) {
+            ERROR("Failed allocating emulation memory node");
+        }
+        emu->va_base = remio_dev->va;
+        emu->size = remio_dev->size;
+        emu->handler = remio_mmio_emul_handler;
+        vm_emul_add_mem(vm, emu);
+    }
+}
+
 static void vm_init_remio(struct vm* vm, const struct vm_config* vm_config)
 {
     if (vm_config->platform.remio_dev_num == 0) {
@@ -239,40 +277,7 @@ static void vm_init_remio(struct vm* vm, const struct vm_config* vm_config)
 
     for (size_t i = 0; i < vm_config->platform.remio_dev_num; i++) {
         struct remio_dev* remio_dev = &vm_config->platform.remio_devs[i];
-        struct shmem* shmem = shmem_get(remio_dev->shmem.shmem_id);
-        if (shmem == NULL) {
-            WARNING("Invalid shmem id in configuration. Ignored.");
-            continue;
-        }
-        size_t shmem_size = remio_dev->shmem.size;
-        if (shmem_size > shmem->size) {
-            shmem_size = shmem->size;
-            WARNING("Trying to map region to smaller shared memory. Truncated");
-        }
-        spin_lock(&shmem->lock);
-        shmem->cpu_masters |= (1UL << cpu()->id);
-        spin_unlock(&shmem->lock);
-
-        struct vm_mem_region reg = {
-            .base = remio_dev->shmem.base,
-            .size = shmem_size,
-            .place_phys = true,
-            .phys = shmem->phys,
-            .colors = shmem->colors,
-        };
-
-        vm_map_mem_region(vm, &reg);
-
-        if (remio_dev->type == REMIO_DEV_FRONTEND) {
-            struct emul_mem* emu = objpool_alloc(&emul_cache);
-            if (emu == NULL) {
-                ERROR("Failed allocating emulation memory node");
-            }
-            emu->va_base = remio_dev->va;
-            emu->size = remio_dev->size;
-            emu->handler = remio_mmio_emul_handler;
-            vm_emul_add_mem(vm, emu);
-        }
+        vm_init_remio_dev(remio_dev, vm);
     }
     remio_assign_vm_cpus(vm);
 }