sysbus.c 6.8 KB
Newer Older
P
Paul Brook 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/*
 *  System (CPU) Bus device support code
 *
 *  Copyright (c) 2009 CodeSourcery
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * 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/>.
P
Paul Brook 已提交
18 19 20
 */

#include "sysbus.h"
21
#include "monitor.h"
22
#include "exec-memory.h"
P
Paul Brook 已提交
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 28 29 30

struct BusInfo system_bus_info = {
    .name       = "System",
    .size       = sizeof(BusState),
    .print_dev  = sysbus_dev_print,
31
    .get_fw_dev_path = sysbus_get_fw_dev_path,
32 33
};

P
Paul Brook 已提交
34 35 36
void sysbus_connect_irq(SysBusDevice *dev, int n, qemu_irq irq)
{
    assert(n >= 0 && n < dev->num_irq);
37
    dev->irqs[n] = NULL;
P
Paul Brook 已提交
38 39 40 41 42
    if (dev->irqp[n]) {
        *dev->irqp[n] = irq;
    }
}

A
Anthony Liguori 已提交
43
void sysbus_mmio_map(SysBusDevice *dev, int n, target_phys_addr_t addr)
P
Paul Brook 已提交
44 45 46 47 48 49 50
{
    assert(n >= 0 && n < dev->num_mmio);

    if (dev->mmio[n].addr == addr) {
        /* ??? region already mapped here.  */
        return;
    }
A
Anthony Liguori 已提交
51
    if (dev->mmio[n].addr != (target_phys_addr_t)-1) {
P
Paul Brook 已提交
52
        /* Unregister previous mapping.  */
53 54 55 56
        if (dev->mmio[n].memory) {
            memory_region_del_subregion(get_system_memory(),
                                        dev->mmio[n].memory);
        }
P
Paul Brook 已提交
57 58
    }
    dev->mmio[n].addr = addr;
59 60 61 62
    if (dev->mmio[n].memory) {
        memory_region_add_subregion(get_system_memory(),
                                    addr,
                                    dev->mmio[n].memory);
P
Paul Brook 已提交
63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87
    }
}


/* Request an IRQ source.  The actual IRQ object may be populated later.  */
void sysbus_init_irq(SysBusDevice *dev, qemu_irq *p)
{
    int n;

    assert(dev->num_irq < QDEV_MAX_IRQ);
    n = dev->num_irq++;
    dev->irqp[n] = p;
}

/* Pass IRQs from a target device.  */
void sysbus_pass_irq(SysBusDevice *dev, SysBusDevice *target)
{
    int i;
    assert(dev->num_irq == 0);
    dev->num_irq = target->num_irq;
    for (i = 0; i < dev->num_irq; i++) {
        dev->irqp[i] = target->irqp[i];
    }
}

88
void sysbus_init_mmio(SysBusDevice *dev, MemoryRegion *memory)
89 90 91 92 93 94 95 96 97
{
    int n;

    assert(dev->num_mmio < QDEV_MAX_MMIO);
    n = dev->num_mmio++;
    dev->mmio[n].addr = -1;
    dev->mmio[n].memory = memory;
}

98 99 100 101 102
MemoryRegion *sysbus_mmio_get_region(SysBusDevice *dev, int n)
{
    return dev->mmio[n].memory;
}

103 104 105 106 107 108 109 110 111 112
void sysbus_init_ioports(SysBusDevice *dev, pio_addr_t ioport, pio_addr_t size)
{
    pio_addr_t i;

    for (i = 0; i < size; i++) {
        assert(dev->num_pio < QDEV_MAX_PIO);
        dev->pio[dev->num_pio++] = ioport++;
    }
}

113
static int sysbus_device_init(DeviceState *dev, DeviceInfo *base)
P
Paul Brook 已提交
114
{
P
Paul Brook 已提交
115
    SysBusDeviceInfo *info = container_of(base, SysBusDeviceInfo, qdev);
P
Paul Brook 已提交
116

117
    return info->init(sysbus_from_qdev(dev));
P
Paul Brook 已提交
118 119
}

120
void sysbus_register_withprop(SysBusDeviceInfo *info)
P
Paul Brook 已提交
121
{
P
Paul Brook 已提交
122
    info->qdev.init = sysbus_device_init;
123
    info->qdev.bus_info = &system_bus_info;
P
Paul Brook 已提交
124

125 126
    assert(info->qdev.size >= sizeof(SysBusDevice));
    qdev_register(&info->qdev);
P
Paul Brook 已提交
127 128
}

P
Paul Brook 已提交
129 130 131 132
void sysbus_register_dev(const char *name, size_t size, sysbus_initfn init)
{
    SysBusDeviceInfo *info;

133 134
    info = g_malloc0(sizeof(*info));
    info->qdev.name = g_strdup(name);
135
    info->qdev.size = size;
P
Paul Brook 已提交
136
    info->init = init;
137
    sysbus_register_withprop(info);
P
Paul Brook 已提交
138 139
}

P
Paul Brook 已提交
140
DeviceState *sysbus_create_varargs(const char *name,
A
Anthony Liguori 已提交
141
                                   target_phys_addr_t addr, ...)
P
Paul Brook 已提交
142 143 144 145 146 147 148 149 150
{
    DeviceState *dev;
    SysBusDevice *s;
    va_list va;
    qemu_irq irq;
    int n;

    dev = qdev_create(NULL, name);
    s = sysbus_from_qdev(dev);
M
Markus Armbruster 已提交
151
    qdev_init_nofail(dev);
A
Anthony Liguori 已提交
152
    if (addr != (target_phys_addr_t)-1) {
P
Paul Brook 已提交
153 154 155 156 157
        sysbus_mmio_map(s, 0, addr);
    }
    va_start(va, addr);
    n = 0;
    while (1) {
158 159 160 161 162 163 164
        irq = va_arg(va, qemu_irq);
        if (!irq) {
            break;
        }
        sysbus_connect_irq(s, n, irq);
        n++;
    }
165
    va_end(va);
166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189
    return dev;
}

DeviceState *sysbus_try_create_varargs(const char *name,
                                       target_phys_addr_t addr, ...)
{
    DeviceState *dev;
    SysBusDevice *s;
    va_list va;
    qemu_irq irq;
    int n;

    dev = qdev_try_create(NULL, name);
    if (!dev) {
        return NULL;
    }
    s = sysbus_from_qdev(dev);
    qdev_init_nofail(dev);
    if (addr != (target_phys_addr_t)-1) {
        sysbus_mmio_map(s, 0, addr);
    }
    va_start(va, addr);
    n = 0;
    while (1) {
P
Paul Brook 已提交
190 191 192 193 194 195 196
        irq = va_arg(va, qemu_irq);
        if (!irq) {
            break;
        }
        sysbus_connect_irq(s, n, irq);
        n++;
    }
197
    va_end(va);
P
Paul Brook 已提交
198 199
    return dev;
}
200

201
static void sysbus_dev_print(Monitor *mon, DeviceState *dev, int indent)
202 203
{
    SysBusDevice *s = sysbus_from_qdev(dev);
A
Avi Kivity 已提交
204
    target_phys_addr_t size;
205 206
    int i;

207
    monitor_printf(mon, "%*sirq %d\n", indent, "", s->num_irq);
208
    for (i = 0; i < s->num_mmio; i++) {
A
Avi Kivity 已提交
209 210 211 212
        size = 0;
        if (s->mmio[i].memory) {
            size = memory_region_size(s->mmio[i].memory);
        }
213
        monitor_printf(mon, "%*smmio " TARGET_FMT_plx "/" TARGET_FMT_plx "\n",
A
Avi Kivity 已提交
214
                       indent, "", s->mmio[i].addr, size);
215 216
    }
}
217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234

static char *sysbus_get_fw_dev_path(DeviceState *dev)
{
    SysBusDevice *s = sysbus_from_qdev(dev);
    char path[40];
    int off;

    off = snprintf(path, sizeof(path), "%s", qdev_fw_name(dev));

    if (s->num_mmio) {
        snprintf(path + off, sizeof(path) - off, "@"TARGET_FMT_plx,
                 s->mmio[0].addr);
    } else if (s->num_pio) {
        snprintf(path + off, sizeof(path) - off, "@i%04x", s->pio[0]);
    }

    return strdup(path);
}
235 236 237 238 239 240 241

void sysbus_add_memory(SysBusDevice *dev, target_phys_addr_t addr,
                       MemoryRegion *mem)
{
    memory_region_add_subregion(get_system_memory(), addr, mem);
}

242 243 244 245 246 247 248
void sysbus_add_memory_overlap(SysBusDevice *dev, target_phys_addr_t addr,
                               MemoryRegion *mem, unsigned priority)
{
    memory_region_add_subregion_overlap(get_system_memory(), addr, mem,
                                        priority);
}

249 250 251 252 253 254 255 256 257 258 259 260 261 262 263
void sysbus_del_memory(SysBusDevice *dev, MemoryRegion *mem)
{
    memory_region_del_subregion(get_system_memory(), mem);
}

void sysbus_add_io(SysBusDevice *dev, target_phys_addr_t addr,
                       MemoryRegion *mem)
{
    memory_region_add_subregion(get_system_io(), addr, mem);
}

void sysbus_del_io(SysBusDevice *dev, MemoryRegion *mem)
{
    memory_region_del_subregion(get_system_io(), mem);
}