hw/integratorcp.c

   1 /*
   2  * ARM Integrator CP System emulation.
   3  *
   4  * Copyright (c) 2005-2007 CodeSourcery.
   5  * Written by Paul Brook
   6  *
   7  * This code is licenced under the GPL
   8  */
   9
  10 #include "vl.h"
  11 #include "arm_pic.h"
  12
  13 void DMA_run (void)
  14 {
  15 }
  16
  17 typedef struct {
  18     uint32_t flash_offset;
  19     uint32_t cm_osc;
  20     uint32_t cm_ctrl;
  21     uint32_t cm_lock;
  22     uint32_t cm_auxosc;
  23     uint32_t cm_sdram;
  24     uint32_t cm_init;
  25     uint32_t cm_flags;
  26     uint32_t cm_nvflags;
  27     uint32_t int_level;
  28     uint32_t irq_enabled;
  29     uint32_t fiq_enabled;
  30 } integratorcm_state;
  31
  32 static uint8_t integrator_spd[128] = {
  33    128, 8, 4, 11, 9, 1, 64, 0,  2, 0xa0, 0xa0, 0, 0, 8, 0, 1,
  34    0xe, 4, 0x1c, 1, 2, 0x20, 0xc0, 0, 0, 0, 0, 0x30, 0x28, 0x30, 0x28, 0x40
  35 };
  36
  37 static uint32_t integratorcm_read(void *opaque, target_phys_addr_t offset)
  38 {
  39     integratorcm_state *s = (integratorcm_state *)opaque;
  40     offset -= 0x10000000;
  41     if (offset >= 0x100 && offset < 0x200) {
  42         /* CM_SPD */
  43         if (offset >= 0x180)
  44             return 0;
  45         return integrator_spd[offset >> 2];
  46     }
  47     switch (offset >> 2) {
  48     case 0: /* CM_ID */
  49         return 0x411a3001;
  50     case 1: /* CM_PROC */
  51         return 0;
  52     case 2: /* CM_OSC */
  53         return s->cm_osc;
  54     case 3: /* CM_CTRL */
  55         return s->cm_ctrl;
  56     case 4: /* CM_STAT */
  57         return 0x00100000;
  58     case 5: /* CM_LOCK */
  59         if (s->cm_lock == 0xa05f) {
  60             return 0x1a05f;
  61         } else {
  62             return s->cm_lock;
  63         }
  64     case 6: /* CM_LMBUSCNT */
  65         /* ??? High frequency timer.  */
  66         cpu_abort(cpu_single_env, "integratorcm_read: CM_LMBUSCNT");
  67     case 7: /* CM_AUXOSC */
  68         return s->cm_auxosc;
  69     case 8: /* CM_SDRAM */
  70         return s->cm_sdram;
  71     case 9: /* CM_INIT */
  72         return s->cm_init;
  73     case 10: /* CM_REFCT */
  74         /* ??? High frequency timer.  */
  75         cpu_abort(cpu_single_env, "integratorcm_read: CM_REFCT");
  76     case 12: /* CM_FLAGS */
  77         return s->cm_flags;
  78     case 14: /* CM_NVFLAGS */
  79         return s->cm_nvflags;
  80     case 16: /* CM_IRQ_STAT */
  81         return s->int_level & s->irq_enabled;
  82     case 17: /* CM_IRQ_RSTAT */
  83         return s->int_level;
  84     case 18: /* CM_IRQ_ENSET */
  85         return s->irq_enabled;
  86     case 20: /* CM_SOFT_INTSET */
  87         return s->int_level & 1;
  88     case 24: /* CM_FIQ_STAT */
  89         return s->int_level & s->fiq_enabled;
  90     case 25: /* CM_FIQ_RSTAT */
  91         return s->int_level;
  92     case 26: /* CM_FIQ_ENSET */
  93         return s->fiq_enabled;
  94     case 32: /* CM_VOLTAGE_CTL0 */
  95     case 33: /* CM_VOLTAGE_CTL1 */
  96     case 34: /* CM_VOLTAGE_CTL2 */
  97     case 35: /* CM_VOLTAGE_CTL3 */
  98         /* ??? Voltage control unimplemented.  */
  99         return 0;
 100     default:
 101         cpu_abort (cpu_single_env,
 102             "integratorcm_read: Unimplemented offset 0x%x\n", (int)offset);
 103         return 0;
 104     }
 105 }
 106
 107 static void integratorcm_do_remap(integratorcm_state *s, int flash)
 108 {
 109     if (flash) {
 110         cpu_register_physical_memory(0, 0x100000, IO_MEM_RAM);
 111     } else {
 112         cpu_register_physical_memory(0, 0x100000, s->flash_offset | IO_MEM_RAM);
 113     }
 114     //??? tlb_flush (cpu_single_env, 1);
 115 }
 116
 117 static void integratorcm_set_ctrl(integratorcm_state *s, uint32_t value)
 118 {
 119     if (value & 8) {
 120         cpu_abort(cpu_single_env, "Board reset\n");
 121     }
 122     if ((s->cm_init ^ value) & 4) {
 123         integratorcm_do_remap(s, (value & 4) == 0);
 124     }
 125     if ((s->cm_init ^ value) & 1) {
 126         printf("Green LED %s\n", (value & 1) ? "on" : "off");
 127     }
 128     s->cm_init = (s->cm_init & ~ 5) | (value ^ 5);
 129 }
 130
 131 static void integratorcm_update(integratorcm_state *s)
 132 {
 133     /* ??? The CPU irq/fiq is raised when either the core module or base PIC
 134        are active.  */
 135     if (s->int_level & (s->irq_enabled | s->fiq_enabled))
 136         cpu_abort(cpu_single_env, "Core module interrupt\n");
 137 }
 138
 139 static void integratorcm_write(void *opaque, target_phys_addr_t offset,
 140                                uint32_t value)
 141 {
 142     integratorcm_state *s = (integratorcm_state *)opaque;
 143     offset -= 0x10000000;
 144     switch (offset >> 2) {
 145     case 2: /* CM_OSC */
 146         if (s->cm_lock == 0xa05f)
 147             s->cm_osc = value;
 148         break;
 149     case 3: /* CM_CTRL */
 150         integratorcm_set_ctrl(s, value);
 151         break;
 152     case 5: /* CM_LOCK */
 153         s->cm_lock = value & 0xffff;
 154         break;
 155     case 7: /* CM_AUXOSC */
 156         if (s->cm_lock == 0xa05f)
 157             s->cm_auxosc = value;
 158         break;
 159     case 8: /* CM_SDRAM */
 160         s->cm_sdram = value;
 161         break;
 162     case 9: /* CM_INIT */
 163         /* ??? This can change the memory bus frequency.  */
 164         s->cm_init = value;
 165         break;
 166     case 12: /* CM_FLAGSS */
 167         s->cm_flags |= value;
 168         break;
 169     case 13: /* CM_FLAGSC */
 170         s->cm_flags &= ~value;
 171         break;
 172     case 14: /* CM_NVFLAGSS */
 173         s->cm_nvflags |= value;
 174         break;
 175     case 15: /* CM_NVFLAGSS */
 176         s->cm_nvflags &= ~value;
 177         break;
 178     case 18: /* CM_IRQ_ENSET */
 179         s->irq_enabled |= value;
 180         integratorcm_update(s);
 181         break;
 182     case 19: /* CM_IRQ_ENCLR */
 183         s->irq_enabled &= ~value;
 184         integratorcm_update(s);
 185         break;
 186     case 20: /* CM_SOFT_INTSET */
 187         s->int_level |= (value & 1);
 188         integratorcm_update(s);
 189         break;
 190     case 21: /* CM_SOFT_INTCLR */
 191         s->int_level &= ~(value & 1);
 192         integratorcm_update(s);
 193         break;
 194     case 26: /* CM_FIQ_ENSET */
 195         s->fiq_enabled |= value;
 196         integratorcm_update(s);
 197         break;
 198     case 27: /* CM_FIQ_ENCLR */
 199         s->fiq_enabled &= ~value;
 200         integratorcm_update(s);
 201         break;
 202     case 32: /* CM_VOLTAGE_CTL0 */
 203     case 33: /* CM_VOLTAGE_CTL1 */
 204     case 34: /* CM_VOLTAGE_CTL2 */
 205     case 35: /* CM_VOLTAGE_CTL3 */
 206         /* ??? Voltage control unimplemented.  */
 207         break;
 208     default:
 209         cpu_abort (cpu_single_env,
 210             "integratorcm_write: Unimplemented offset 0x%x\n", (int)offset);
 211         break;
 212     }
 213 }
 214
 215 /* Integrator/CM control registers.  */
 216
 217 static CPUReadMemoryFunc *integratorcm_readfn[] = {
 218    integratorcm_read,
 219    integratorcm_read,
 220    integratorcm_read
 221 };
 222
 223 static CPUWriteMemoryFunc *integratorcm_writefn[] = {
 224    integratorcm_write,
 225    integratorcm_write,
 226    integratorcm_write
 227 };
 228
 229 static void integratorcm_init(int memsz, uint32_t flash_offset)
 230 {
 231     int iomemtype;
 232     integratorcm_state *s;
 233
 234     s = (integratorcm_state *)qemu_mallocz(sizeof(integratorcm_state));
 235     s->cm_osc = 0x01000048;
 236     /* ??? What should the high bits of this value be?  */
 237     s->cm_auxosc = 0x0007feff;
 238     s->cm_sdram = 0x00011122;
 239     if (memsz >= 256) {
 240         integrator_spd[31] = 64;
 241         s->cm_sdram |= 0x10;
 242     } else if (memsz >= 128) {
 243         integrator_spd[31] = 32;
 244         s->cm_sdram |= 0x0c;
 245     } else if (memsz >= 64) {
 246         integrator_spd[31] = 16;
 247         s->cm_sdram |= 0x08;
 248     } else if (memsz >= 32) {
 249         integrator_spd[31] = 4;
 250         s->cm_sdram |= 0x04;
 251     } else {
 252         integrator_spd[31] = 2;
 253     }
 254     memcpy(integrator_spd + 73, "QEMU-MEMORY", 11);
 255     s->cm_init = 0x00000112;
 256     s->flash_offset = flash_offset;
 257
 258     iomemtype = cpu_register_io_memory(0, integratorcm_readfn,
 259                                        integratorcm_writefn, s);
 260     cpu_register_physical_memory(0x10000000, 0x00800000, iomemtype);
 261     integratorcm_do_remap(s, 1);
 262     /* ??? Save/restore.  */
 263 }
 264
 265 /* Integrator/CP hardware emulation.  */
 266 /* Primary interrupt controller.  */
 267
 268 typedef struct icp_pic_state
 269 {
 270   uint32_t base;
 271   uint32_t level;
 272   uint32_t irq_enabled;
 273   uint32_t fiq_enabled;
 274   qemu_irq parent_irq;
 275   qemu_irq parent_fiq;
 276 } icp_pic_state;
 277
 278 static void icp_pic_update(icp_pic_state *s)
 279 {
 280     uint32_t flags;
 281
 282     flags = (s->level & s->irq_enabled);
 283     qemu_set_irq(s->parent_irq, flags != 0);
 284     flags = (s->level & s->fiq_enabled);
 285     qemu_set_irq(s->parent_fiq, flags != 0);
 286 }
 287
 288 static void icp_pic_set_irq(void *opaque, int irq, int level)
 289 {
 290     icp_pic_state *s = (icp_pic_state *)opaque;
 291     if (level)
 292         s->level |= 1 << irq;
 293     else
 294         s->level &= ~(1 << irq);
 295     icp_pic_update(s);
 296 }
 297
 298 static uint32_t icp_pic_read(void *opaque, target_phys_addr_t offset)
 299 {
 300     icp_pic_state *s = (icp_pic_state *)opaque;
 301
 302     offset -= s->base;
 303     switch (offset >> 2) {
 304     case 0: /* IRQ_STATUS */
 305         return s->level & s->irq_enabled;
 306     case 1: /* IRQ_RAWSTAT */
 307         return s->level;
 308     case 2: /* IRQ_ENABLESET */
 309         return s->irq_enabled;
 310     case 4: /* INT_SOFTSET */
 311         return s->level & 1;
 312     case 8: /* FRQ_STATUS */
 313         return s->level & s->fiq_enabled;
 314     case 9: /* FRQ_RAWSTAT */
 315         return s->level;
 316     case 10: /* FRQ_ENABLESET */
 317         return s->fiq_enabled;
 318     case 3: /* IRQ_ENABLECLR */
 319     case 5: /* INT_SOFTCLR */
 320     case 11: /* FRQ_ENABLECLR */
 321     default:
 322         printf ("icp_pic_read: Bad register offset 0x%x\n", (int)offset);
 323         return 0;
 324     }
 325 }
 326
 327 static void icp_pic_write(void *opaque, target_phys_addr_t offset,
 328                           uint32_t value)
 329 {
 330     icp_pic_state *s = (icp_pic_state *)opaque;
 331     offset -= s->base;
 332
 333     switch (offset >> 2) {
 334     case 2: /* IRQ_ENABLESET */
 335         s->irq_enabled |= value;
 336         break;
 337     case 3: /* IRQ_ENABLECLR */
 338         s->irq_enabled &= ~value;
 339         break;
 340     case 4: /* INT_SOFTSET */
 341         if (value & 1)
 342             icp_pic_set_irq(s, 0, 1);
 343         break;
 344     case 5: /* INT_SOFTCLR */
 345         if (value & 1)
 346             icp_pic_set_irq(s, 0, 0);
 347         break;
 348     case 10: /* FRQ_ENABLESET */
 349         s->fiq_enabled |= value;
 350         break;
 351     case 11: /* FRQ_ENABLECLR */
 352         s->fiq_enabled &= ~value;
 353         break;
 354     case 0: /* IRQ_STATUS */
 355     case 1: /* IRQ_RAWSTAT */
 356     case 8: /* FRQ_STATUS */
 357     case 9: /* FRQ_RAWSTAT */
 358     default:
 359         printf ("icp_pic_write: Bad register offset 0x%x\n", (int)offset);
 360         return;
 361     }
 362     icp_pic_update(s);
 363 }
 364
 365 static CPUReadMemoryFunc *icp_pic_readfn[] = {
 366    icp_pic_read,
 367    icp_pic_read,
 368    icp_pic_read
 369 };
 370
 371 static CPUWriteMemoryFunc *icp_pic_writefn[] = {
 372    icp_pic_write,
 373    icp_pic_write,
 374    icp_pic_write
 375 };
 376
 377 static qemu_irq *icp_pic_init(uint32_t base,
 378                               qemu_irq parent_irq, qemu_irq parent_fiq)
 379 {
 380     icp_pic_state *s;
 381     int iomemtype;
 382     qemu_irq *qi;
 383
 384     s = (icp_pic_state *)qemu_mallocz(sizeof(icp_pic_state));
 385     if (!s)
 386         return NULL;
 387     qi = qemu_allocate_irqs(icp_pic_set_irq, s, 32);
 388     s->base = base;
 389     s->parent_irq = parent_irq;
 390     s->parent_fiq = parent_fiq;
 391     iomemtype = cpu_register_io_memory(0, icp_pic_readfn,
 392                                        icp_pic_writefn, s);
 393     cpu_register_physical_memory(base, 0x00800000, iomemtype);
 394     /* ??? Save/restore.  */
 395     return qi;
 396 }
 397
 398 /* CP control registers.  */
 399 typedef struct {
 400     uint32_t base;
 401 } icp_control_state;
 402
 403 static uint32_t icp_control_read(void *opaque, target_phys_addr_t offset)
 404 {
 405     icp_control_state *s = (icp_control_state *)opaque;
 406     offset -= s->base;
 407     switch (offset >> 2) {
 408     case 0: /* CP_IDFIELD */
 409         return 0x41034003;
 410     case 1: /* CP_FLASHPROG */
 411         return 0;
 412     case 2: /* CP_INTREG */
 413         return 0;
 414     case 3: /* CP_DECODE */
 415         return 0x11;
 416     default:
 417         cpu_abort (cpu_single_env, "icp_control_read: Bad offset %x\n",
 418                    (int)offset);
 419         return 0;
 420     }
 421 }
 422
 423 static void icp_control_write(void *opaque, target_phys_addr_t offset,
 424                           uint32_t value)
 425 {
 426     icp_control_state *s = (icp_control_state *)opaque;
 427     offset -= s->base;
 428     switch (offset >> 2) {
 429     case 1: /* CP_FLASHPROG */
 430     case 2: /* CP_INTREG */
 431     case 3: /* CP_DECODE */
 432         /* Nothing interesting implemented yet.  */
 433         break;
 434     default:
 435         cpu_abort (cpu_single_env, "icp_control_write: Bad offset %x\n",
 436                    (int)offset);
 437     }
 438 }
 439 static CPUReadMemoryFunc *icp_control_readfn[] = {
 440    icp_control_read,
 441    icp_control_read,
 442    icp_control_read
 443 };
 444
 445 static CPUWriteMemoryFunc *icp_control_writefn[] = {
 446    icp_control_write,
 447    icp_control_write,
 448    icp_control_write
 449 };
 450
 451 static void icp_control_init(uint32_t base)
 452 {
 453     int iomemtype;
 454     icp_control_state *s;
 455
 456     s = (icp_control_state *)qemu_mallocz(sizeof(icp_control_state));
 457     iomemtype = cpu_register_io_memory(0, icp_control_readfn,
 458                                        icp_control_writefn, s);
 459     cpu_register_physical_memory(base, 0x00800000, iomemtype);
 460     s->base = base;
 461     /* ??? Save/restore.  */
 462 }
 463
 464
 465 /* Board init.  */
 466
 467 static void integratorcp_init(int ram_size, int vga_ram_size,
 468                      const char *boot_device, DisplayState *ds,
 469                      const char **fd_filename, int snapshot,
 470                      const char *kernel_filename, const char *kernel_cmdline,
 471                      const char *initrd_filename, const char *cpu_model)
 472 {
 473     CPUState *env;
 474     uint32_t bios_offset;
 475     qemu_irq *pic;
 476     qemu_irq *cpu_pic;
 477
 478     if (!cpu_model)
 479         cpu_model = "arm926";
 480     env = cpu_init(cpu_model);
 481     if (!env) {
 482         fprintf(stderr, "Unable to find CPU definition\n");
 483         exit(1);
 484     }
 485     bios_offset = ram_size + vga_ram_size;
 486     /* ??? On a real system the first 1Mb is mapped as SSRAM or boot flash.  */
 487     /* ??? RAM shoud repeat to fill physical memory space.  */
 488     /* SDRAM at address zero*/
 489     cpu_register_physical_memory(0, ram_size, IO_MEM_RAM);
 490     /* And again at address 0x80000000 */
 491     cpu_register_physical_memory(0x80000000, ram_size, IO_MEM_RAM);
 492
 493     integratorcm_init(ram_size >> 20, bios_offset);
 494     cpu_pic = arm_pic_init_cpu(env);
 495     pic = icp_pic_init(0x14000000, cpu_pic[ARM_PIC_CPU_IRQ],
 496                        cpu_pic[ARM_PIC_CPU_FIQ]);
 497     icp_pic_init(0xca000000, pic[26], NULL);
 498     icp_pit_init(0x13000000, pic, 5);
 499     pl031_init(0x15000000, pic[8]);
 500     pl011_init(0x16000000, pic[1], serial_hds[0], PL011_ARM);
 501     pl011_init(0x17000000, pic[2], serial_hds[1], PL011_ARM);
 502     icp_control_init(0xcb000000);
 503     pl050_init(0x18000000, pic[3], 0);
 504     pl050_init(0x19000000, pic[4], 1);
 505     pl181_init(0x1c000000, sd_bdrv, pic[23], pic[24]);
 506     if (nd_table[0].vlan) {
 507         if (nd_table[0].model == NULL
 508             || strcmp(nd_table[0].model, "smc91c111") == 0) {
 509             smc91c111_init(&nd_table[0], 0xc8000000, pic[27]);
 510         } else if (strcmp(nd_table[0].model, "?") == 0) {
 511             fprintf(stderr, "qemu: Supported NICs: smc91c111\n");
 512             exit (1);
 513         } else {
 514             fprintf(stderr, "qemu: Unsupported NIC: %s\n", nd_table[0].model);
 515             exit (1);
 516         }
 517     }
 518     pl110_init(ds, 0xc0000000, pic[22], 0);
 519
 520     arm_load_kernel(env, ram_size, kernel_filename, kernel_cmdline,
 521                     initrd_filename, 0x113, 0x0);
 522 }
 523
 524 QEMUMachine integratorcp_machine = {
 525     "integratorcp",
 526     "ARM Integrator/CP (ARM926EJ-S)",
 527     integratorcp_init,
 528 };