Add a 8 MiB pflash controller for BIOS firmware, and boot
from it if possible.

Signed-off-by: Jiaxun Yang <jiaxun.y...@flygoat.com>
---
 hw/m68k/Kconfig                                   |  1 +
 hw/m68k/virt.c                                    | 44 +++++++++++++++++++++++
 include/standard-headers/asm-m68k/bootinfo-virt.h |  1 +
 3 files changed, 46 insertions(+)

diff --git a/hw/m68k/Kconfig b/hw/m68k/Kconfig
index 4501da56ff6d..f233a5948f19 100644
--- a/hw/m68k/Kconfig
+++ b/hw/m68k/Kconfig
@@ -42,6 +42,7 @@ config M68K_VIRT
     select M68K_IRQC
     select FW_CFG_DMA
     select VIRT_CTRL
+    select PFLASH_CFI01
     select GOLDFISH_PIC
     select GOLDFISH_TTY
     select GOLDFISH_RTC
diff --git a/hw/m68k/virt.c b/hw/m68k/virt.c
index 7590e6515ac3..a2eebc0f2243 100644
--- a/hw/m68k/virt.c
+++ b/hw/m68k/virt.c
@@ -8,6 +8,7 @@
  */
 
 #include "qemu/osdep.h"
+#include "qemu/datadir.h"
 #include "qemu/units.h"
 #include "qemu/guest-random.h"
 #include "sysemu/sysemu.h"
@@ -28,6 +29,7 @@
 #include "sysemu/runstate.h"
 #include "sysemu/reset.h"
 
+#include "hw/block/flash.h"
 #include "hw/intc/m68k_irqc.h"
 #include "hw/misc/virt_ctrl.h"
 #include "hw/char/goldfish_tty.h"
@@ -97,6 +99,10 @@
 #define VIRT_XHCI_MMIO_BASE 0xff020000    /* MMIO: 0xff020000 - 0xff023fff */
 #define VIRT_XHCI_IRQ_BASE  PIC_IRQ(1, 2) /* PIC: #1, IRQ: #2 */
 
+#define VIRT_PFLASH_MMIO_BASE 0xff800000      /* MMIO: 0xff800000 - 0xffffffff 
*/
+#define VIRT_PFLASH_SIZE      0x800000        /* 8 MiB */
+#define VIRT_PFLASH_SECTOR_SIZE (128 * KiB)   /* 64 KiB */
+
 typedef struct {
     M68kCPU *cpu;
     hwaddr initial_pc;
@@ -139,6 +145,7 @@ static void virt_init(MachineState *machine)
     const char *initrd_filename = machine->initrd_filename;
     const char *kernel_cmdline = machine->kernel_cmdline;
     hwaddr parameters_base;
+    DriveInfo *dinfo;
     DeviceState *dev;
     DeviceState *irqc_dev;
     DeviceState *pic_dev[VIRT_GF_PIC_NB];
@@ -165,6 +172,8 @@ static void virt_init(MachineState *machine)
     cpu = M68K_CPU(cpu_create(machine->cpu_type));
 
     reset_info->cpu = cpu;
+    reset_info->initial_pc = VIRT_PFLASH_MMIO_BASE;
+    reset_info->initial_stack = ram_size;
     qemu_register_reset(main_cpu_reset, reset_info);
 
     /* RAM */
@@ -253,6 +262,39 @@ static void virt_init(MachineState *machine)
                         PIC_GPIO(VIRT_XHCI_IRQ_BASE));
     }
 
+    /* pflash */
+    dinfo = drive_get(IF_PFLASH, 0, 0);
+    pflash_cfi01_register(VIRT_PFLASH_MMIO_BASE,
+                          "virt.pflash0",
+                           VIRT_PFLASH_SIZE,
+                           dinfo ? blk_by_legacy_dinfo(dinfo) : NULL,
+                           VIRT_PFLASH_SECTOR_SIZE, 4,
+                           0x89, 0x18, 0, 0, 1);
+
+    if (machine->firmware) {
+        char *fn;
+        int image_size;
+
+        if (drive_get(IF_PFLASH, 0, 0)) {
+            error_report("The contents of the first flash device may be "
+                         "specified with -bios or with -drive if=pflash... "
+                         "but you cannot use both options at once");
+            exit(1);
+        }
+        fn = qemu_find_file(QEMU_FILE_TYPE_BIOS, machine->firmware);
+        if (!fn) {
+            error_report("Could not find ROM image '%s'", machine->firmware);
+            exit(1);
+        }
+        image_size = load_image_targphys(fn, VIRT_PFLASH_MMIO_BASE,
+                                         VIRT_PFLASH_SIZE);
+        g_free(fn);
+        if (image_size < 0) {
+            error_report("Could not load ROM image '%s'", machine->firmware);
+            exit(1);
+        }
+    }
+
     if (kernel_filename) {
         CPUState *cs = CPU(cpu);
         uint64_t high;
@@ -311,6 +353,8 @@ static void virt_init(MachineState *machine)
         }
         BOOTINFO2(param_ptr, BI_VIRT_FW_CFG_BASE,
                   VIRT_FW_CFG_MMIO_BASE, VIRT_FW_CFG_IRQ_BASE);
+        BOOTINFO2(param_ptr, BI_VIRT_PFLASH_BASE,
+                    VIRT_PFLASH_MMIO_BASE, 0);
 
         if (kernel_cmdline) {
             BOOTINFOSTR(param_ptr, BI_COMMAND_LINE,
diff --git a/include/standard-headers/asm-m68k/bootinfo-virt.h 
b/include/standard-headers/asm-m68k/bootinfo-virt.h
index 7f90be1aa7bd..21c9a98d2912 100644
--- a/include/standard-headers/asm-m68k/bootinfo-virt.h
+++ b/include/standard-headers/asm-m68k/bootinfo-virt.h
@@ -18,6 +18,7 @@
 
 #define BI_VIRT_XHCI_BASE      0x8007
 #define BI_VIRT_FW_CFG_BASE    0x8008
+#define BI_VIRT_PFLASH_BASE    0x8009
 
 #define VIRT_BOOTI_VERSION     MK_BI_VERSION(2, 0)
 

-- 
2.43.0


Reply via email to