hw/sysbus.c

   1 /*
   2  *  System (CPU) Bus device support code
   3  *
   4  *  Copyright (c) 2009 CodeSourcery
   5  *
   6  * This library is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU Lesser General Public
   8  * License as published by the Free Software Foundation; either
   9  * version 2 of the License, or (at your option) any later version.
  10  *
  11  * This library is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * Lesser General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU Lesser General Public
  17  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include "sysbus.h"
  21 #include "monitor.h"
  22 #include "exec-memory.h"
  23
  24 static void sysbus_dev_print(Monitor *mon, DeviceState *dev, int indent);
  25 static char *sysbus_get_fw_dev_path(DeviceState *dev);
  26
  27 struct BusInfo system_bus_info = {
  28     .name       = "System",
  29     .size       = sizeof(BusState),
  30     .print_dev  = sysbus_dev_print,
  31     .get_fw_dev_path = sysbus_get_fw_dev_path,
  32 };
  33
  34 void sysbus_connect_irq(SysBusDevice *dev, int n, qemu_irq irq)
  35 {
  36     assert(n >= 0 && n < dev->num_irq);
  37     dev->irqs[n] = NULL;
  38     if (dev->irqp[n]) {
  39         *dev->irqp[n] = irq;
  40     }
  41 }
  42
  43 void sysbus_mmio_map(SysBusDevice *dev, int n, target_phys_addr_t addr)
  44 {
  45     assert(n >= 0 && n < dev->num_mmio);
  46
  47     if (dev->mmio[n].addr == addr) {
  48         /* ??? region already mapped here.  */
  49         return;
  50     }
  51     if (dev->mmio[n].addr != (target_phys_addr_t)-1) {
  52         /* Unregister previous mapping.  */
  53         if (dev->mmio[n].memory) {
  54             memory_region_del_subregion(get_system_memory(),
  55                                         dev->mmio[n].memory);
  56         } else {
  57             cpu_register_physical_memory(dev->mmio[n].addr, dev->mmio[n].size,
  58                                          IO_MEM_UNASSIGNED);
  59         }
  60     }
  61     dev->mmio[n].addr = addr;
  62     if (dev->mmio[n].memory) {
  63         memory_region_add_subregion(get_system_memory(),
  64                                     addr,
  65                                     dev->mmio[n].memory);
  66     } else if (dev->mmio[n].cb) {
  67         dev->mmio[n].cb(dev, addr);
  68     } else {
  69         cpu_register_physical_memory(addr, dev->mmio[n].size,
  70                                      dev->mmio[n].iofunc);
  71     }
  72 }
  73
  74
  75 /* Request an IRQ source.  The actual IRQ object may be populated later.  */
  76 void sysbus_init_irq(SysBusDevice *dev, qemu_irq *p)
  77 {
  78     int n;
  79
  80     assert(dev->num_irq < QDEV_MAX_IRQ);
  81     n = dev->num_irq++;
  82     dev->irqp[n] = p;
  83 }
  84
  85 /* Pass IRQs from a target device.  */
  86 void sysbus_pass_irq(SysBusDevice *dev, SysBusDevice *target)
  87 {
  88     int i;
  89     assert(dev->num_irq == 0);
  90     dev->num_irq = target->num_irq;
  91     for (i = 0; i < dev->num_irq; i++) {
  92         dev->irqp[i] = target->irqp[i];
  93     }
  94 }
  95
  96 void sysbus_init_mmio(SysBusDevice *dev, target_phys_addr_t size,
  97                       ram_addr_t iofunc)
  98 {
  99     int n;
 100
 101     assert(dev->num_mmio < QDEV_MAX_MMIO);
 102     n = dev->num_mmio++;
 103     dev->mmio[n].addr = -1;
 104     dev->mmio[n].size = size;
 105     dev->mmio[n].iofunc = iofunc;
 106 }
 107
 108 void sysbus_init_mmio_cb(SysBusDevice *dev, target_phys_addr_t size,
 109                          mmio_mapfunc cb)
 110 {
 111     int n;
 112
 113     assert(dev->num_mmio < QDEV_MAX_MMIO);
 114     n = dev->num_mmio++;
 115     dev->mmio[n].addr = -1;
 116     dev->mmio[n].size = size;
 117     dev->mmio[n].cb = cb;
 118 }
 119
 120 void sysbus_init_mmio_region(SysBusDevice *dev, MemoryRegion *memory)
 121 {
 122     int n;
 123
 124     assert(dev->num_mmio < QDEV_MAX_MMIO);
 125     n = dev->num_mmio++;
 126     dev->mmio[n].addr = -1;
 127     dev->mmio[n].size = memory_region_size(memory);
 128     dev->mmio[n].memory = memory;
 129 }
 130
 131 void sysbus_init_ioports(SysBusDevice *dev, pio_addr_t ioport, pio_addr_t size)
 132 {
 133     pio_addr_t i;
 134
 135     for (i = 0; i < size; i++) {
 136         assert(dev->num_pio < QDEV_MAX_PIO);
 137         dev->pio[dev->num_pio++] = ioport++;
 138     }
 139 }
 140
 141 static int sysbus_device_init(DeviceState *dev, DeviceInfo *base)
 142 {
 143     SysBusDeviceInfo *info = container_of(base, SysBusDeviceInfo, qdev);
 144
 145     return info->init(sysbus_from_qdev(dev));
 146 }
 147
 148 void sysbus_register_withprop(SysBusDeviceInfo *info)
 149 {
 150     info->qdev.init = sysbus_device_init;
 151     info->qdev.bus_info = &system_bus_info;
 152
 153     assert(info->qdev.size >= sizeof(SysBusDevice));
 154     qdev_register(&info->qdev);
 155 }
 156
 157 void sysbus_register_dev(const char *name, size_t size, sysbus_initfn init)
 158 {
 159     SysBusDeviceInfo *info;
 160
 161     info = g_malloc0(sizeof(*info));
 162     info->qdev.name = g_strdup(name);
 163     info->qdev.size = size;
 164     info->init = init;
 165     sysbus_register_withprop(info);
 166 }
 167
 168 DeviceState *sysbus_create_varargs(const char *name,
 169                                    target_phys_addr_t addr, ...)
 170 {
 171     DeviceState *dev;
 172     SysBusDevice *s;
 173     va_list va;
 174     qemu_irq irq;
 175     int n;
 176
 177     dev = qdev_create(NULL, name);
 178     s = sysbus_from_qdev(dev);
 179     qdev_init_nofail(dev);
 180     if (addr != (target_phys_addr_t)-1) {
 181         sysbus_mmio_map(s, 0, addr);
 182     }
 183     va_start(va, addr);
 184     n = 0;
 185     while (1) {
 186         irq = va_arg(va, qemu_irq);
 187         if (!irq) {
 188             break;
 189         }
 190         sysbus_connect_irq(s, n, irq);
 191         n++;
 192     }
 193     return dev;
 194 }
 195
 196 DeviceState *sysbus_try_create_varargs(const char *name,
 197                                        target_phys_addr_t addr, ...)
 198 {
 199     DeviceState *dev;
 200     SysBusDevice *s;
 201     va_list va;
 202     qemu_irq irq;
 203     int n;
 204
 205     dev = qdev_try_create(NULL, name);
 206     if (!dev) {
 207         return NULL;
 208     }
 209     s = sysbus_from_qdev(dev);
 210     qdev_init_nofail(dev);
 211     if (addr != (target_phys_addr_t)-1) {
 212         sysbus_mmio_map(s, 0, addr);
 213     }
 214     va_start(va, addr);
 215     n = 0;
 216     while (1) {
 217         irq = va_arg(va, qemu_irq);
 218         if (!irq) {
 219             break;
 220         }
 221         sysbus_connect_irq(s, n, irq);
 222         n++;
 223     }
 224     return dev;
 225 }
 226
 227 static void sysbus_dev_print(Monitor *mon, DeviceState *dev, int indent)
 228 {
 229     SysBusDevice *s = sysbus_from_qdev(dev);
 230     int i;
 231
 232     monitor_printf(mon, "%*sirq %d\n", indent, "", s->num_irq);
 233     for (i = 0; i < s->num_mmio; i++) {
 234         monitor_printf(mon, "%*smmio " TARGET_FMT_plx "/" TARGET_FMT_plx "\n",
 235                        indent, "", s->mmio[i].addr, s->mmio[i].size);
 236     }
 237 }
 238
 239 static char *sysbus_get_fw_dev_path(DeviceState *dev)
 240 {
 241     SysBusDevice *s = sysbus_from_qdev(dev);
 242     char path[40];
 243     int off;
 244
 245     off = snprintf(path, sizeof(path), "%s", qdev_fw_name(dev));
 246
 247     if (s->num_mmio) {
 248         snprintf(path + off, sizeof(path) - off, "@"TARGET_FMT_plx,
 249                  s->mmio[0].addr);
 250     } else if (s->num_pio) {
 251         snprintf(path + off, sizeof(path) - off, "@i%04x", s->pio[0]);
 252     }
 253
 254     return strdup(path);
 255 }