Changeset 3625 for trunk/src/host/qemu-neo1973/hw/neo1973.c

Timestamp:

12/10/07 18:38:35 (5 years ago)

Author:

andrew

Message:

Add a machine ID register on the pseudo-gta02 machine.

File:

• trunk/src/host/qemu-neo1973/hw/neo1973.c (modified) (6 diffs)

trunk/src/host/qemu-neo1973/hw/neo1973.c

@@ -88 +88 @@
     const char *kernel;
     struct sd_card_s *mmc;
+    uint32_t id;
 };
 
@@ -432 +433 @@
 static struct neo_board_s *neo1973_init_common(int ram_size, DisplayState *ds,
                 const char *kernel_filename, const char *cpu_model,
-                struct sd_card_s *mmc)
+                struct sd_card_s *mmc, uint32_t id)
 {
     struct neo_board_s *s = (struct neo_board_s *)
@@ -440 +441 @@
     s->kernel = kernel_filename;
     s->mmc = mmc;
+    s->id = id;
 
     /* Setup CPU & memory */
@@ -484 +486 @@
 }
 
+static uint32_t neo_machid_read(void *opaque, target_phys_addr_t addr)
+{
+    return 'Q';
+}
+
+static void neo_machid_write(void *opaque,
+                target_phys_addr_t addr, uint32_t val)
+{
+    struct neo_board_s *s = (struct neo_board_s *) opaque;
+
+    if ((val >> 4) == 'Q')
+        s->cpu->env->regs[val & 0xf] = s->id;
+}
+
+static void neo_machid_init(struct neo_board_s *s)
+{
+    static CPUReadMemoryFunc *readfn[] = {
+        neo_machid_read, neo_machid_read, neo_machid_read,
+    };
+    static CPUWriteMemoryFunc *writefn[] = {
+        neo_machid_write, neo_machid_write, neo_machid_write,
+    };
+    int iomemtype = cpu_register_io_memory(0, readfn, writefn, s);
+
+    /* SROM chipselect 5 base */
+    cpu_register_physical_memory(0x28000000, 1, iomemtype);
+}
+
 static void gta01_init(int ram_size, int vga_ram_size,
                 const char *boot_device, DisplayState *ds,
@@ -495 +525 @@
         sd = sd_init(drives_table[sd_idx].bdrv, 0);
 
-    neo1973_init_common(ram_size, ds, kernel_filename, cpu_model, sd);
+    neo1973_init_common(ram_size, ds,
+                    kernel_filename, cpu_model, sd, 1304);
 }
 
@@ -505 +536 @@
     struct neo_board_s *neo;
 
-    neo = neo1973_init_common(ram_size, ds, kernel_filename, cpu_model, 0);
+    neo = neo1973_init_common(ram_size, ds,
+                    kernel_filename, cpu_model, 0, 1555);
 
     neo_gps_setup(neo);
+    neo_machid_init(neo);
 }