arm11mpcore.c 3.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106
  1. /*
  2. * ARM11MPCore internal peripheral emulation.
  3. *
  4. * Copyright (c) 2006-2007 CodeSourcery.
  5. * Written by Paul Brook
  6. *
  7. * This code is licensed under the GPL.
  8. */
  9. /* ??? The MPCore TRM says the on-chip controller has 224 external IRQ lines
  10. (+ 32 internal). However my test chip only exposes/reports 32.
  11. More importantly Linux falls over if more than 32 are present! */
  12. #define GIC_NIRQ 64
  13. #include "mpcore.c"
  14. /* Dummy PIC to route IRQ lines. The baseboard has 4 independent IRQ
  15. controllers. The output of these, plus some of the raw input lines
  16. are fed into a single SMP-aware interrupt controller on the CPU. */
  17. typedef struct {
  18. SysBusDevice busdev;
  19. SysBusDevice *priv;
  20. qemu_irq cpuic[32];
  21. qemu_irq rvic[4][64];
  22. uint32_t num_cpu;
  23. } mpcore_rirq_state;
  24. /* Map baseboard IRQs onto CPU IRQ lines. */
  25. static const int mpcore_irq_map[32] = {
  26. -1, -1, -1, -1, 1, 2, -1, -1,
  27. -1, -1, 6, -1, 4, 5, -1, -1,
  28. -1, 14, 15, 0, 7, 8, -1, -1,
  29. -1, -1, -1, -1, 9, 3, -1, -1,
  30. };
  31. static void mpcore_rirq_set_irq(void *opaque, int irq, int level)
  32. {
  33. mpcore_rirq_state *s = (mpcore_rirq_state *)opaque;
  34. int i;
  35. for (i = 0; i < 4; i++) {
  36. qemu_set_irq(s->rvic[i][irq], level);
  37. }
  38. if (irq < 32) {
  39. irq = mpcore_irq_map[irq];
  40. if (irq >= 0) {
  41. qemu_set_irq(s->cpuic[irq], level);
  42. }
  43. }
  44. }
  45. static int realview_mpcore_init(SysBusDevice *dev)
  46. {
  47. mpcore_rirq_state *s = FROM_SYSBUS(mpcore_rirq_state, dev);
  48. DeviceState *gic;
  49. DeviceState *priv;
  50. int n;
  51. int i;
  52. priv = qdev_create(NULL, "arm11mpcore_priv");
  53. qdev_prop_set_uint32(priv, "num-cpu", s->num_cpu);
  54. qdev_init_nofail(priv);
  55. s->priv = sysbus_from_qdev(priv);
  56. sysbus_pass_irq(dev, s->priv);
  57. for (i = 0; i < 32; i++) {
  58. s->cpuic[i] = qdev_get_gpio_in(priv, i);
  59. }
  60. /* ??? IRQ routing is hardcoded to "normal" mode. */
  61. for (n = 0; n < 4; n++) {
  62. gic = sysbus_create_simple("realview_gic", 0x10040000 + n * 0x10000,
  63. s->cpuic[10 + n]);
  64. for (i = 0; i < 64; i++) {
  65. s->rvic[n][i] = qdev_get_gpio_in(gic, i);
  66. }
  67. }
  68. qdev_init_gpio_in(&dev->qdev, mpcore_rirq_set_irq, 64);
  69. sysbus_init_mmio_region(dev, sysbus_mmio_get_region(s->priv, 0));
  70. return 0;
  71. }
  72. static SysBusDeviceInfo mpcore_rirq_info = {
  73. .init = realview_mpcore_init,
  74. .qdev.name = "realview_mpcore",
  75. .qdev.size = sizeof(mpcore_rirq_state),
  76. .qdev.props = (Property[]) {
  77. DEFINE_PROP_UINT32("num-cpu", mpcore_rirq_state, num_cpu, 1),
  78. DEFINE_PROP_END_OF_LIST(),
  79. }
  80. };
  81. static SysBusDeviceInfo mpcore_priv_info = {
  82. .init = mpcore_priv_init,
  83. .qdev.name = "arm11mpcore_priv",
  84. .qdev.size = sizeof(mpcore_priv_state),
  85. .qdev.props = (Property[]) {
  86. DEFINE_PROP_UINT32("num-cpu", mpcore_priv_state, num_cpu, 1),
  87. DEFINE_PROP_END_OF_LIST(),
  88. }
  89. };
  90. static void arm11mpcore_register_devices(void)
  91. {
  92. sysbus_register_withprop(&mpcore_rirq_info);
  93. sysbus_register_withprop(&mpcore_priv_info);
  94. }
  95. device_init(arm11mpcore_register_devices)