Commit 7233b355571ad2a8e7aec7eb19db5f530e81f052
1 parent
d2c38b24
Mainstone re-org, by Armin Kuster.
git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@3758 c046a42c-6fe2-441c-8c8c-71466251a162
Showing
4 changed files
with
290 additions
and
241 deletions
Makefile.target
| ... | ... | @@ -496,9 +496,10 @@ VL_OBJS+= arm-semi.o |
| 496 | 496 | VL_OBJS+= pxa2xx.o pxa2xx_pic.o pxa2xx_gpio.o pxa2xx_timer.o pxa2xx_dma.o |
| 497 | 497 | VL_OBJS+= pxa2xx_lcd.o pxa2xx_mmci.o pxa2xx_pcmcia.o |
| 498 | 498 | VL_OBJS+= pflash_cfi01.o gumstix.o |
| 499 | -VL_OBJS+= spitz.o ide.o serial.o nand.o ecc.o mainstone.o | |
| 499 | +VL_OBJS+= spitz.o ide.o serial.o nand.o ecc.o | |
| 500 | 500 | VL_OBJS+= omap.o omap_lcdc.o omap1_clk.o omap_mmc.o omap_i2c.o |
| 501 | 501 | VL_OBJS+= palm.o tsc210x.o |
| 502 | +VL_OBJS+= mst_fpga.o mainstone.o | |
| 502 | 503 | CPPFLAGS += -DHAS_AUDIO |
| 503 | 504 | endif |
| 504 | 505 | ifeq ($(TARGET_BASE_ARCH), sh4) | ... | ... |
hw/mainstone.c
| ... | ... | @@ -14,245 +14,9 @@ |
| 14 | 14 | #include "net.h" |
| 15 | 15 | #include "devices.h" |
| 16 | 16 | #include "boards.h" |
| 17 | - | |
| 18 | -#define MST_ETH_PHYS 0x10000300 | |
| 19 | -#define MST_FPGA_PHYS 0x08000000 | |
| 20 | - | |
| 21 | -/* Mainstone FPGA for extern irqs */ | |
| 22 | -#define FPGA_GPIO_PIN 0 | |
| 23 | -#define MST_NUM_IRQS 16 | |
| 24 | -#define MST_BASE MST_FPGA_PHYS | |
| 25 | -#define MST_LEDDAT1 0x10 | |
| 26 | -#define MST_LEDDAT2 0x14 | |
| 27 | -#define MST_LEDCTRL 0x40 | |
| 28 | -#define MST_GPSWR 0x60 | |
| 29 | -#define MST_MSCWR1 0x80 | |
| 30 | -#define MST_MSCWR2 0x84 | |
| 31 | -#define MST_MSCWR3 0x88 | |
| 32 | -#define MST_MSCRD 0x90 | |
| 33 | -#define MST_INTMSKENA 0xc0 | |
| 34 | -#define MST_INTSETCLR 0xd0 | |
| 35 | -#define MST_PCMCIA0 0xe0 | |
| 36 | -#define MST_PCMCIA1 0xe4 | |
| 37 | - | |
| 38 | -/* IRQ definitions */ | |
| 39 | -#define ETHERNET_IRQ 3 | |
| 40 | - | |
| 41 | -typedef struct mst_irq_state { | |
| 42 | - target_phys_addr_t target_base; | |
| 43 | - qemu_irq *parent; | |
| 44 | - qemu_irq *pins; | |
| 45 | - | |
| 46 | - uint32_t prev_level; | |
| 47 | - uint32_t leddat1; | |
| 48 | - uint32_t leddat2; | |
| 49 | - uint32_t ledctrl; | |
| 50 | - uint32_t gpswr; | |
| 51 | - uint32_t mscwr1; | |
| 52 | - uint32_t mscwr2; | |
| 53 | - uint32_t mscwr3; | |
| 54 | - uint32_t mscrd; | |
| 55 | - uint32_t intmskena; | |
| 56 | - uint32_t intsetclr; | |
| 57 | - uint32_t pcmcia0; | |
| 58 | - uint32_t pcmcia1; | |
| 59 | -} mst_irq_state; | |
| 60 | - | |
| 61 | -static void | |
| 62 | -mst_fpga_update_gpio(mst_irq_state *s) | |
| 63 | -{ | |
| 64 | - uint32_t level, diff; | |
| 65 | - int bit; | |
| 66 | - level = s->prev_level ^ s->intsetclr; | |
| 67 | - | |
| 68 | - for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) { | |
| 69 | - bit = ffs(diff) - 1; | |
| 70 | - qemu_set_irq(s->pins[bit], (level >> bit) & 1 ); | |
| 71 | - } | |
| 72 | - s->prev_level = level; | |
| 73 | -} | |
| 74 | - | |
| 75 | -static void | |
| 76 | -mst_fpga_set_irq(void *opaque, int irq, int level) | |
| 77 | -{ | |
| 78 | - mst_irq_state *s = (mst_irq_state *)opaque; | |
| 79 | - | |
| 80 | - if (level) | |
| 81 | - s->prev_level |= 1u << irq; | |
| 82 | - else | |
| 83 | - s->prev_level &= ~(1u << irq); | |
| 84 | - | |
| 85 | - if(s->intmskena & (1u << irq)) { | |
| 86 | - s->intsetclr = 1u << irq; | |
| 87 | - qemu_set_irq(s->parent[0], level); | |
| 88 | - } | |
| 89 | -} | |
| 90 | - | |
| 91 | -static uint32_t | |
| 92 | -mst_fpga_readb(void *opaque, target_phys_addr_t addr) | |
| 93 | -{ | |
| 94 | - mst_irq_state *s = (mst_irq_state *) opaque; | |
| 95 | - addr -= s->target_base; | |
| 96 | - | |
| 97 | - switch (addr) { | |
| 98 | - case MST_LEDDAT1: | |
| 99 | - return s->leddat1; | |
| 100 | - case MST_LEDDAT2: | |
| 101 | - return s->leddat2; | |
| 102 | - case MST_LEDCTRL: | |
| 103 | - return s->ledctrl; | |
| 104 | - case MST_GPSWR: | |
| 105 | - return s->gpswr; | |
| 106 | - case MST_MSCWR1: | |
| 107 | - return s->mscwr1; | |
| 108 | - case MST_MSCWR2: | |
| 109 | - return s->mscwr2; | |
| 110 | - case MST_MSCWR3: | |
| 111 | - return s->mscwr3; | |
| 112 | - case MST_MSCRD: | |
| 113 | - return s->mscrd; | |
| 114 | - case MST_INTMSKENA: | |
| 115 | - return s->intmskena; | |
| 116 | - case MST_INTSETCLR: | |
| 117 | - return s->intsetclr; | |
| 118 | - case MST_PCMCIA0: | |
| 119 | - return s->pcmcia0; | |
| 120 | - case MST_PCMCIA1: | |
| 121 | - return s->pcmcia1; | |
| 122 | - default: | |
| 123 | - printf("Mainstone - mst_fpga_readb: Bad register offset " | |
| 124 | - REG_FMT " \n", addr); | |
| 125 | - } | |
| 126 | - return 0; | |
| 127 | -} | |
| 128 | - | |
| 129 | -static void | |
| 130 | -mst_fpga_writeb(void *opaque, target_phys_addr_t addr, uint32_t value) | |
| 131 | -{ | |
| 132 | - mst_irq_state *s = (mst_irq_state *) opaque; | |
| 133 | - addr -= s->target_base; | |
| 134 | - value &= 0xffffffff; | |
| 135 | - | |
| 136 | - switch (addr) { | |
| 137 | - case MST_LEDDAT1: | |
| 138 | - s->leddat1 = value; | |
| 139 | - break; | |
| 140 | - case MST_LEDDAT2: | |
| 141 | - s->leddat2 = value; | |
| 142 | - break; | |
| 143 | - case MST_LEDCTRL: | |
| 144 | - s->ledctrl = value; | |
| 145 | - break; | |
| 146 | - case MST_GPSWR: | |
| 147 | - s->gpswr = value; | |
| 148 | - break; | |
| 149 | - case MST_MSCWR1: | |
| 150 | - s->mscwr1 = value; | |
| 151 | - break; | |
| 152 | - case MST_MSCWR2: | |
| 153 | - s->mscwr2 = value; | |
| 154 | - break; | |
| 155 | - case MST_MSCWR3: | |
| 156 | - s->mscwr3 = value; | |
| 157 | - break; | |
| 158 | - case MST_MSCRD: | |
| 159 | - s->mscrd = value; | |
| 160 | - break; | |
| 161 | - case MST_INTMSKENA: /* Mask interupt */ | |
| 162 | - s->intmskena = (value & 0xFEEFF); | |
| 163 | - mst_fpga_update_gpio(s); | |
| 164 | - break; | |
| 165 | - case MST_INTSETCLR: /* clear or set interrupt */ | |
| 166 | - s->intsetclr = (value & 0xFEEFF); | |
| 167 | - break; | |
| 168 | - case MST_PCMCIA0: | |
| 169 | - s->pcmcia0 = value; | |
| 170 | - break; | |
| 171 | - case MST_PCMCIA1: | |
| 172 | - s->pcmcia1 = value; | |
| 173 | - break; | |
| 174 | - default: | |
| 175 | - printf("Mainstone - mst_fpga_writeb: Bad register offset " | |
| 176 | - REG_FMT " \n", addr); | |
| 177 | - } | |
| 178 | -} | |
| 179 | - | |
| 180 | -CPUReadMemoryFunc *mst_fpga_readfn[] = { | |
| 181 | - mst_fpga_readb, | |
| 182 | - mst_fpga_readb, | |
| 183 | - mst_fpga_readb, | |
| 184 | -}; | |
| 185 | -CPUWriteMemoryFunc *mst_fpga_writefn[] = { | |
| 186 | - mst_fpga_writeb, | |
| 187 | - mst_fpga_writeb, | |
| 188 | - mst_fpga_writeb, | |
| 189 | -}; | |
| 190 | - | |
| 191 | -static void | |
| 192 | -mst_fpga_save(QEMUFile *f, void *opaque) | |
| 193 | -{ | |
| 194 | - struct mst_irq_state *s = (mst_irq_state *) opaque; | |
| 195 | - | |
| 196 | - qemu_put_be32s(f, &s->prev_level); | |
| 197 | - qemu_put_be32s(f, &s->leddat1); | |
| 198 | - qemu_put_be32s(f, &s->leddat2); | |
| 199 | - qemu_put_be32s(f, &s->ledctrl); | |
| 200 | - qemu_put_be32s(f, &s->gpswr); | |
| 201 | - qemu_put_be32s(f, &s->mscwr1); | |
| 202 | - qemu_put_be32s(f, &s->mscwr2); | |
| 203 | - qemu_put_be32s(f, &s->mscwr3); | |
| 204 | - qemu_put_be32s(f, &s->mscrd); | |
| 205 | - qemu_put_be32s(f, &s->intmskena); | |
| 206 | - qemu_put_be32s(f, &s->intsetclr); | |
| 207 | - qemu_put_be32s(f, &s->pcmcia0); | |
| 208 | - qemu_put_be32s(f, &s->pcmcia1); | |
| 209 | -} | |
| 210 | - | |
| 211 | -static int | |
| 212 | -mst_fpga_load(QEMUFile *f, void *opaque, int version_id) | |
| 213 | -{ | |
| 214 | - mst_irq_state *s = (mst_irq_state *) opaque; | |
| 215 | - | |
| 216 | - qemu_get_be32s(f, &s->prev_level); | |
| 217 | - qemu_get_be32s(f, &s->leddat1); | |
| 218 | - qemu_get_be32s(f, &s->leddat2); | |
| 219 | - qemu_get_be32s(f, &s->ledctrl); | |
| 220 | - qemu_get_be32s(f, &s->gpswr); | |
| 221 | - qemu_get_be32s(f, &s->mscwr1); | |
| 222 | - qemu_get_be32s(f, &s->mscwr2); | |
| 223 | - qemu_get_be32s(f, &s->mscwr3); | |
| 224 | - qemu_get_be32s(f, &s->mscrd); | |
| 225 | - qemu_get_be32s(f, &s->intmskena); | |
| 226 | - qemu_get_be32s(f, &s->intsetclr); | |
| 227 | - qemu_get_be32s(f, &s->pcmcia0); | |
| 228 | - qemu_get_be32s(f, &s->pcmcia1); | |
| 229 | - return 0; | |
| 230 | -} | |
| 231 | - | |
| 232 | -static qemu_irq | |
| 233 | -*mst_irq_init(struct pxa2xx_state_s *cpu, uint32_t base, int irq) | |
| 234 | -{ | |
| 235 | - mst_irq_state *s; | |
| 236 | - int iomemtype; | |
| 237 | - qemu_irq *qi; | |
| 238 | - | |
| 239 | - s = (mst_irq_state *) qemu_mallocz(sizeof(mst_irq_state)); | |
| 240 | - | |
| 241 | - if (!s) | |
| 242 | - return NULL; | |
| 243 | - s->target_base = base; | |
| 244 | - s->parent = &cpu->pic[irq]; | |
| 245 | - | |
| 246 | - /* alloc the external 16 irqs */ | |
| 247 | - qi = qemu_allocate_irqs(mst_fpga_set_irq, s, MST_NUM_IRQS); | |
| 248 | - s->pins = qi; | |
| 249 | - | |
| 250 | - iomemtype = cpu_register_io_memory(0, mst_fpga_readfn, | |
| 251 | - mst_fpga_writefn, s); | |
| 252 | - cpu_register_physical_memory(MST_BASE, 0x00100000, iomemtype); | |
| 253 | - register_savevm("mainstone_fpga", 0, 0, mst_fpga_save, mst_fpga_load, s); | |
| 254 | - return qi; | |
| 255 | -} | |
| 17 | +#include "mainstone.h" | |
| 18 | +#include "sysemu.h" | |
| 19 | +#include "flash.h" | |
| 256 | 20 | |
| 257 | 21 | enum mainstone_model_e { mainstone }; |
| 258 | 22 | |
| ... | ... | @@ -283,7 +47,20 @@ static void mainstone_common_init(int ram_size, int vga_ram_size, |
| 283 | 47 | /* Setup initial (reset) machine state */ |
| 284 | 48 | cpu->env->regs[15] = PXA2XX_SDRAM_BASE; |
| 285 | 49 | |
| 286 | - mst_irq = mst_irq_init(cpu, MST_BASE, PXA2XX_PIC_GPIO_0); | |
| 50 | + /* There are two 32MiB flash devices on the board */ | |
| 51 | + if (!pflash_register(MST_FLASH_0, mainstone_ram + PXA2XX_INTERNAL_SIZE, | |
| 52 | + pflash_table[0], 256 * 1024, 128, 4, 0, 0, 0, 0)) { | |
| 53 | + fprintf(stderr, "qemu: Error register flash memory.\n"); | |
| 54 | + exit(1); | |
| 55 | + } | |
| 56 | + | |
| 57 | + if (!pflash_register(MST_FLASH_1, mainstone_ram + PXA2XX_INTERNAL_SIZE, | |
| 58 | + pflash_table[1], 256 * 1024, 128, 4, 0, 0, 0, 0)) { | |
| 59 | + fprintf(stderr, "qemu: Error register flash memory.\n"); | |
| 60 | + exit(1); | |
| 61 | + } | |
| 62 | + | |
| 63 | + mst_irq = mst_irq_init(cpu, MST_FPGA_PHYS, PXA2XX_PIC_GPIO_0); | |
| 287 | 64 | smc91c111_init(&nd_table[0], MST_ETH_PHYS, mst_irq[ETHERNET_IRQ]); |
| 288 | 65 | |
| 289 | 66 | arm_load_kernel(cpu->env, mainstone_ram, kernel_filename, kernel_cmdline, | ... | ... |
hw/mainstone.h
0 โ 100644
| 1 | +/* | |
| 2 | + * PXA270-based Intel Mainstone platforms. | |
| 3 | + * | |
| 4 | + * Copyright (c) 2007 by Armin Kuster <akuster@kama-aina.net> or | |
| 5 | + * <akuster@mvista.com> | |
| 6 | + * | |
| 7 | + * This code is licensed under the GNU GPL v2. | |
| 8 | + */ | |
| 9 | + | |
| 10 | +#ifndef __MAINSTONE_H__ | |
| 11 | +#define __MAINSTONE_H__ | |
| 12 | + | |
| 13 | +/* Device addresses */ | |
| 14 | +#define MST_FPGA_PHYS 0x08000000 | |
| 15 | +#define MST_ETH_PHYS 0x10000300 | |
| 16 | +#define MST_FLASH_0 0x00000000 | |
| 17 | +#define MST_FLASH_1 0x04000000 | |
| 18 | + | |
| 19 | +/* IRQ definitions */ | |
| 20 | +#define ETHERNET_IRQ 3 | |
| 21 | + | |
| 22 | +extern qemu_irq | |
| 23 | +*mst_irq_init(struct pxa2xx_state_s *cpu, uint32_t base, int irq); | |
| 24 | + | |
| 25 | +#endif /* __MAINSTONE_H__ */ | ... | ... |
hw/mst_fpga.c
0 โ 100644
| 1 | +/* | |
| 2 | + * PXA270-based Intel Mainstone platforms. | |
| 3 | + * FPGA driver | |
| 4 | + * | |
| 5 | + * Copyright (c) 2007 by Armin Kuster <akuster@kama-aina.net> or | |
| 6 | + * <akuster@mvista.com> | |
| 7 | + * | |
| 8 | + * This code is licensed under the GNU GPL v2. | |
| 9 | + */ | |
| 10 | +#include "hw.h" | |
| 11 | +#include "pxa.h" | |
| 12 | +#include "mainstone.h" | |
| 13 | + | |
| 14 | +/* Mainstone FPGA for extern irqs */ | |
| 15 | +#define FPGA_GPIO_PIN 0 | |
| 16 | +#define MST_NUM_IRQS 16 | |
| 17 | +#define MST_BASE MST_FPGA_PHYS | |
| 18 | +#define MST_LEDDAT1 0x10 | |
| 19 | +#define MST_LEDDAT2 0x14 | |
| 20 | +#define MST_LEDCTRL 0x40 | |
| 21 | +#define MST_GPSWR 0x60 | |
| 22 | +#define MST_MSCWR1 0x80 | |
| 23 | +#define MST_MSCWR2 0x84 | |
| 24 | +#define MST_MSCWR3 0x88 | |
| 25 | +#define MST_MSCRD 0x90 | |
| 26 | +#define MST_INTMSKENA 0xc0 | |
| 27 | +#define MST_INTSETCLR 0xd0 | |
| 28 | +#define MST_PCMCIA0 0xe0 | |
| 29 | +#define MST_PCMCIA1 0xe4 | |
| 30 | + | |
| 31 | +typedef struct mst_irq_state{ | |
| 32 | + target_phys_addr_t target_base; | |
| 33 | + qemu_irq *parent; | |
| 34 | + qemu_irq *pins; | |
| 35 | + | |
| 36 | + uint32_t prev_level; | |
| 37 | + uint32_t leddat1; | |
| 38 | + uint32_t leddat2; | |
| 39 | + uint32_t ledctrl; | |
| 40 | + uint32_t gpswr; | |
| 41 | + uint32_t mscwr1; | |
| 42 | + uint32_t mscwr2; | |
| 43 | + uint32_t mscwr3; | |
| 44 | + uint32_t mscrd; | |
| 45 | + uint32_t intmskena; | |
| 46 | + uint32_t intsetclr; | |
| 47 | + uint32_t pcmcia0; | |
| 48 | + uint32_t pcmcia1; | |
| 49 | +}mst_irq_state; | |
| 50 | + | |
| 51 | +static void | |
| 52 | +mst_fpga_update_gpio(mst_irq_state *s) | |
| 53 | +{ | |
| 54 | + uint32_t level, diff; | |
| 55 | + int bit; | |
| 56 | + level = s->prev_level ^ s->intsetclr; | |
| 57 | + | |
| 58 | + for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) { | |
| 59 | + bit = ffs(diff) - 1; | |
| 60 | + qemu_set_irq(s->pins[bit], (level >> bit) & 1 ); | |
| 61 | + } | |
| 62 | + s->prev_level = level; | |
| 63 | +} | |
| 64 | + | |
| 65 | +static void | |
| 66 | +mst_fpga_set_irq(void *opaque, int irq, int level) | |
| 67 | +{ | |
| 68 | + mst_irq_state *s = (mst_irq_state *)opaque; | |
| 69 | + | |
| 70 | + if (level) | |
| 71 | + s->prev_level |= 1u << irq; | |
| 72 | + else | |
| 73 | + s->prev_level &= ~(1u << irq); | |
| 74 | + | |
| 75 | + if(s->intmskena & (1u << irq)) { | |
| 76 | + s->intsetclr = 1u << irq; | |
| 77 | + qemu_set_irq(s->parent[0], level); | |
| 78 | + } | |
| 79 | +} | |
| 80 | + | |
| 81 | + | |
| 82 | +static uint32_t | |
| 83 | +mst_fpga_readb(void *opaque, target_phys_addr_t addr) | |
| 84 | +{ | |
| 85 | + mst_irq_state *s = (mst_irq_state *) opaque; | |
| 86 | + addr -= s->target_base; | |
| 87 | + | |
| 88 | + switch (addr) { | |
| 89 | + case MST_LEDDAT1: | |
| 90 | + return s->leddat1; | |
| 91 | + case MST_LEDDAT2: | |
| 92 | + return s->leddat2; | |
| 93 | + case MST_LEDCTRL: | |
| 94 | + return s->ledctrl; | |
| 95 | + case MST_GPSWR: | |
| 96 | + return s->gpswr; | |
| 97 | + case MST_MSCWR1: | |
| 98 | + return s->mscwr1; | |
| 99 | + case MST_MSCWR2: | |
| 100 | + return s->mscwr2; | |
| 101 | + case MST_MSCWR3: | |
| 102 | + return s->mscwr3; | |
| 103 | + case MST_MSCRD: | |
| 104 | + return s->mscrd; | |
| 105 | + case MST_INTMSKENA: | |
| 106 | + return s->intmskena; | |
| 107 | + case MST_INTSETCLR: | |
| 108 | + return s->intsetclr; | |
| 109 | + case MST_PCMCIA0: | |
| 110 | + return s->pcmcia0; | |
| 111 | + case MST_PCMCIA1: | |
| 112 | + return s->pcmcia1; | |
| 113 | + default: | |
| 114 | + printf("Mainstone - mst_fpga_readb: Bad register offset " | |
| 115 | + REG_FMT " \n", addr); | |
| 116 | + } | |
| 117 | + return 0; | |
| 118 | +} | |
| 119 | + | |
| 120 | +static void | |
| 121 | +mst_fpga_writeb(void *opaque, target_phys_addr_t addr, uint32_t value) | |
| 122 | +{ | |
| 123 | + mst_irq_state *s = (mst_irq_state *) opaque; | |
| 124 | + addr -= s->target_base; | |
| 125 | + value &= 0xffffffff; | |
| 126 | + | |
| 127 | + switch (addr) { | |
| 128 | + case MST_LEDDAT1: | |
| 129 | + s->leddat1 = value; | |
| 130 | + break; | |
| 131 | + case MST_LEDDAT2: | |
| 132 | + s->leddat2 = value; | |
| 133 | + break; | |
| 134 | + case MST_LEDCTRL: | |
| 135 | + s->ledctrl = value; | |
| 136 | + break; | |
| 137 | + case MST_GPSWR: | |
| 138 | + s->gpswr = value; | |
| 139 | + break; | |
| 140 | + case MST_MSCWR1: | |
| 141 | + s->mscwr1 = value; | |
| 142 | + break; | |
| 143 | + case MST_MSCWR2: | |
| 144 | + s->mscwr2 = value; | |
| 145 | + break; | |
| 146 | + case MST_MSCWR3: | |
| 147 | + s->mscwr3 = value; | |
| 148 | + break; | |
| 149 | + case MST_MSCRD: | |
| 150 | + s->mscrd = value; | |
| 151 | + break; | |
| 152 | + case MST_INTMSKENA: /* Mask interupt */ | |
| 153 | + s->intmskena = (value & 0xFEEFF); | |
| 154 | + mst_fpga_update_gpio(s); | |
| 155 | + break; | |
| 156 | + case MST_INTSETCLR: /* clear or set interrupt */ | |
| 157 | + s->intsetclr = (value & 0xFEEFF); | |
| 158 | + break; | |
| 159 | + case MST_PCMCIA0: | |
| 160 | + s->pcmcia0 = value; | |
| 161 | + break; | |
| 162 | + case MST_PCMCIA1: | |
| 163 | + s->pcmcia1 = value; | |
| 164 | + break; | |
| 165 | + default: | |
| 166 | + printf("Mainstone - mst_fpga_writeb: Bad register offset " | |
| 167 | + REG_FMT " \n", addr); | |
| 168 | + } | |
| 169 | +} | |
| 170 | + | |
| 171 | +CPUReadMemoryFunc *mst_fpga_readfn[] = { | |
| 172 | + mst_fpga_readb, | |
| 173 | + mst_fpga_readb, | |
| 174 | + mst_fpga_readb, | |
| 175 | +}; | |
| 176 | +CPUWriteMemoryFunc *mst_fpga_writefn[] = { | |
| 177 | + mst_fpga_writeb, | |
| 178 | + mst_fpga_writeb, | |
| 179 | + mst_fpga_writeb, | |
| 180 | +}; | |
| 181 | + | |
| 182 | +static void | |
| 183 | +mst_fpga_save(QEMUFile *f, void *opaque) | |
| 184 | +{ | |
| 185 | + struct mst_irq_state *s = (mst_irq_state *) opaque; | |
| 186 | + | |
| 187 | + qemu_put_be32s(f, &s->prev_level); | |
| 188 | + qemu_put_be32s(f, &s->leddat1); | |
| 189 | + qemu_put_be32s(f, &s->leddat2); | |
| 190 | + qemu_put_be32s(f, &s->ledctrl); | |
| 191 | + qemu_put_be32s(f, &s->gpswr); | |
| 192 | + qemu_put_be32s(f, &s->mscwr1); | |
| 193 | + qemu_put_be32s(f, &s->mscwr2); | |
| 194 | + qemu_put_be32s(f, &s->mscwr3); | |
| 195 | + qemu_put_be32s(f, &s->mscrd); | |
| 196 | + qemu_put_be32s(f, &s->intmskena); | |
| 197 | + qemu_put_be32s(f, &s->intsetclr); | |
| 198 | + qemu_put_be32s(f, &s->pcmcia0); | |
| 199 | + qemu_put_be32s(f, &s->pcmcia1); | |
| 200 | +} | |
| 201 | + | |
| 202 | +static int | |
| 203 | +mst_fpga_load(QEMUFile *f, void *opaque, int version_id) | |
| 204 | +{ | |
| 205 | + mst_irq_state *s = (mst_irq_state *) opaque; | |
| 206 | + | |
| 207 | + qemu_get_be32s(f, &s->prev_level); | |
| 208 | + qemu_get_be32s(f, &s->leddat1); | |
| 209 | + qemu_get_be32s(f, &s->leddat2); | |
| 210 | + qemu_get_be32s(f, &s->ledctrl); | |
| 211 | + qemu_get_be32s(f, &s->gpswr); | |
| 212 | + qemu_get_be32s(f, &s->mscwr1); | |
| 213 | + qemu_get_be32s(f, &s->mscwr2); | |
| 214 | + qemu_get_be32s(f, &s->mscwr3); | |
| 215 | + qemu_get_be32s(f, &s->mscrd); | |
| 216 | + qemu_get_be32s(f, &s->intmskena); | |
| 217 | + qemu_get_be32s(f, &s->intsetclr); | |
| 218 | + qemu_get_be32s(f, &s->pcmcia0); | |
| 219 | + qemu_get_be32s(f, &s->pcmcia1); | |
| 220 | + return 0; | |
| 221 | +} | |
| 222 | + | |
| 223 | +qemu_irq *mst_irq_init(struct pxa2xx_state_s *cpu, uint32_t base, int irq) | |
| 224 | +{ | |
| 225 | + mst_irq_state *s; | |
| 226 | + int iomemtype; | |
| 227 | + qemu_irq *qi; | |
| 228 | + | |
| 229 | + s = (mst_irq_state *) | |
| 230 | + qemu_mallocz(sizeof(mst_irq_state)); | |
| 231 | + | |
| 232 | + if (!s) | |
| 233 | + return NULL; | |
| 234 | + s->target_base = base; | |
| 235 | + s->parent = &cpu->pic[irq]; | |
| 236 | + | |
| 237 | + /* alloc the external 16 irqs */ | |
| 238 | + qi = qemu_allocate_irqs(mst_fpga_set_irq, s, MST_NUM_IRQS); | |
| 239 | + s->pins = qi; | |
| 240 | + | |
| 241 | + iomemtype = cpu_register_io_memory(0, mst_fpga_readfn, | |
| 242 | + mst_fpga_writefn, s); | |
| 243 | + cpu_register_physical_memory(MST_BASE, 0x00100000, iomemtype); | |
| 244 | + register_savevm("mainstone_fpga", 0, 0, mst_fpga_save, mst_fpga_load, s); | |
| 245 | + return qi; | |
| 246 | +} | ... | ... |