pci.c 29.9 KB
Newer Older
bellard's avatar
bellard committed
1 2 3 4
/*
 * QEMU PCI bus manager
 *
 * Copyright (c) 2004 Fabrice Bellard
5
 *
bellard's avatar
bellard committed
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
pbrook's avatar
pbrook committed
24 25
#include "hw.h"
#include "pci.h"
aliguori's avatar
aliguori committed
26
#include "monitor.h"
pbrook's avatar
pbrook committed
27
#include "net.h"
28
#include "sysemu.h"
bellard's avatar
bellard committed
29 30

//#define DEBUG_PCI
31 32 33 34 35
#ifdef DEBUG_PCI
# define PCI_DPRINTF(format, ...)       printf(format, __VA_ARGS__)
#else
# define PCI_DPRINTF(format, ...)       do { } while (0)
#endif
bellard's avatar
bellard committed
36

37
struct PCIBus {
Paul Brook's avatar
Paul Brook committed
38
    BusState qbus;
39 40
    int bus_num;
    int devfn_min;
pbrook's avatar
pbrook committed
41
    pci_set_irq_fn set_irq;
42
    pci_map_irq_fn map_irq;
43
    uint32_t config_reg; /* XXX: suppress */
44 45
    /* low level pic */
    SetIRQFunc *low_set_irq;
pbrook's avatar
pbrook committed
46
    qemu_irq *irq_opaque;
47
    PCIDevice *devices[256];
pbrook's avatar
pbrook committed
48 49
    PCIDevice *parent_dev;
    PCIBus *next;
50 51
    /* The bus IRQ state is the logical OR of the connected devices.
       Keep a count of the number of devices with raised IRQs.  */
52
    int nirq;
53 54 55 56 57 58 59 60 61
    int *irq_count;
};

static void pcibus_dev_print(Monitor *mon, DeviceState *dev, int indent);

static struct BusInfo pci_bus_info = {
    .name       = "PCI",
    .size       = sizeof(PCIBus),
    .print_dev  = pcibus_dev_print,
62 63 64 65 66 67 68 69 70
    .props      = (Property[]) {
        {
            .name   = "devfn",
            .info   = &qdev_prop_uint32,
            .offset = offsetof(PCIDevice, devfn),
            .defval = (uint32_t[]) { -1 },
        },
        {/* end of list */}
    }
71
};
bellard's avatar
bellard committed
72

bellard's avatar
bellard committed
73
static void pci_update_mappings(PCIDevice *d);
pbrook's avatar
pbrook committed
74
static void pci_set_irq(void *opaque, int irq_num, int level);
bellard's avatar
bellard committed
75

bellard's avatar
bellard committed
76
target_phys_addr_t pci_mem_base;
77 78
static uint16_t pci_default_sub_vendor_id = PCI_SUBVENDOR_ID_REDHAT_QUMRANET;
static uint16_t pci_default_sub_device_id = PCI_SUBDEVICE_ID_QEMU;
79 80
static PCIBus *first_bus;

81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111
static void pcibus_save(QEMUFile *f, void *opaque)
{
    PCIBus *bus = (PCIBus *)opaque;
    int i;

    qemu_put_be32(f, bus->nirq);
    for (i = 0; i < bus->nirq; i++)
        qemu_put_be32(f, bus->irq_count[i]);
}

static int  pcibus_load(QEMUFile *f, void *opaque, int version_id)
{
    PCIBus *bus = (PCIBus *)opaque;
    int i, nirq;

    if (version_id != 1)
        return -EINVAL;

    nirq = qemu_get_be32(f);
    if (bus->nirq != nirq) {
        fprintf(stderr, "pcibus_load: nirq mismatch: src=%d dst=%d\n",
                nirq, bus->nirq);
        return -EINVAL;
    }

    for (i = 0; i < nirq; i++)
        bus->irq_count[i] = qemu_get_be32(f);

    return 0;
}

Gleb Natapov's avatar
Gleb Natapov committed
112 113 114 115 116 117 118 119 120 121 122 123 124 125 126
static void pci_bus_reset(void *opaque)
{
    PCIBus *bus = (PCIBus *)opaque;
    int i;

    for (i = 0; i < bus->nirq; i++) {
        bus->irq_count[i] = 0;
    }
    for (i = 0; i < 256; i++) {
        if (bus->devices[i])
            memset(bus->devices[i]->irq_state, 0,
                   sizeof(bus->devices[i]->irq_state));
    }
}

Paul Brook's avatar
Paul Brook committed
127 128
PCIBus *pci_register_bus(DeviceState *parent, const char *name,
                         pci_set_irq_fn set_irq, pci_map_irq_fn map_irq,
pbrook's avatar
pbrook committed
129
                         qemu_irq *pic, int devfn_min, int nirq)
130 131
{
    PCIBus *bus;
132 133
    static int nbus = 0;

134
    bus = FROM_QBUS(PCIBus, qbus_create(&pci_bus_info, parent, name));
pbrook's avatar
pbrook committed
135
    bus->set_irq = set_irq;
136
    bus->map_irq = map_irq;
pbrook's avatar
pbrook committed
137 138
    bus->irq_opaque = pic;
    bus->devfn_min = devfn_min;
139
    bus->nirq = nirq;
Paul Brook's avatar
Paul Brook committed
140
    bus->irq_count = qemu_mallocz(nirq * sizeof(bus->irq_count[0]));
141
    bus->next = first_bus;
142
    first_bus = bus;
143
    register_savevm("PCIBUS", nbus++, 1, pcibus_save, pcibus_load, bus);
144
    qemu_register_reset(pci_bus_reset, bus);
145 146
    return bus;
}
bellard's avatar
bellard committed
147

148
static PCIBus *pci_register_secondary_bus(PCIDevice *dev, pci_map_irq_fn map_irq)
pbrook's avatar
pbrook committed
149 150
{
    PCIBus *bus;
Gerd Hoffmann's avatar
Gerd Hoffmann committed
151

152
    bus = qemu_mallocz(sizeof(PCIBus));
pbrook's avatar
pbrook committed
153 154 155 156 157 158 159
    bus->map_irq = map_irq;
    bus->parent_dev = dev;
    bus->next = dev->bus->next;
    dev->bus->next = bus;
    return bus;
}

pbrook's avatar
pbrook committed
160 161 162 163 164
int pci_bus_num(PCIBus *s)
{
    return s->bus_num;
}

bellard's avatar
bellard committed
165
void pci_device_save(PCIDevice *s, QEMUFile *f)
166
{
167 168 169
    int i;

    qemu_put_be32(f, 2); /* PCI device version */
170
    qemu_put_buffer(f, s->config, 256);
171 172
    for (i = 0; i < 4; i++)
        qemu_put_be32(f, s->irq_state[i]);
173 174
}

bellard's avatar
bellard committed
175
int pci_device_load(PCIDevice *s, QEMUFile *f)
176
{
177
    uint8_t config[PCI_CONFIG_SPACE_SIZE];
bellard's avatar
bellard committed
178
    uint32_t version_id;
179 180
    int i;

bellard's avatar
bellard committed
181
    version_id = qemu_get_be32(f);
182
    if (version_id > 2)
183
        return -EINVAL;
184 185 186 187 188 189
    qemu_get_buffer(f, config, sizeof config);
    for (i = 0; i < sizeof config; ++i)
        if ((config[i] ^ s->config[i]) & s->cmask[i] & ~s->wmask[i])
            return -EINVAL;
    memcpy(s->config, config, sizeof config);

bellard's avatar
bellard committed
190
    pci_update_mappings(s);
191 192 193 194

    if (version_id >= 2)
        for (i = 0; i < 4; i ++)
            s->irq_state[i] = qemu_get_be32(f);
195 196 197
    return 0;
}

198 199 200 201 202 203 204 205 206 207
static int pci_set_default_subsystem_id(PCIDevice *pci_dev)
{
    uint16_t *id;

    id = (void*)(&pci_dev->config[PCI_SUBVENDOR_ID]);
    id[0] = cpu_to_le16(pci_default_sub_vendor_id);
    id[1] = cpu_to_le16(pci_default_sub_device_id);
    return 0;
}

208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256
/*
 * Parse [[<domain>:]<bus>:]<slot>, return -1 on error
 */
static int pci_parse_devaddr(const char *addr, int *domp, int *busp, unsigned *slotp)
{
    const char *p;
    char *e;
    unsigned long val;
    unsigned long dom = 0, bus = 0;
    unsigned slot = 0;

    p = addr;
    val = strtoul(p, &e, 16);
    if (e == p)
	return -1;
    if (*e == ':') {
	bus = val;
	p = e + 1;
	val = strtoul(p, &e, 16);
	if (e == p)
	    return -1;
	if (*e == ':') {
	    dom = bus;
	    bus = val;
	    p = e + 1;
	    val = strtoul(p, &e, 16);
	    if (e == p)
		return -1;
	}
    }

    if (dom > 0xffff || bus > 0xff || val > 0x1f)
	return -1;

    slot = val;

    if (*e)
	return -1;

    /* Note: QEMU doesn't implement domains other than 0 */
    if (dom != 0 || pci_find_bus(bus) == NULL)
	return -1;

    *domp = dom;
    *busp = bus;
    *slotp = slot;
    return 0;
}

257 258
int pci_read_devaddr(Monitor *mon, const char *addr, int *domp, int *busp,
                     unsigned *slotp)
259
{
260 261 262 263 264 265
    /* strip legacy tag */
    if (!strncmp(addr, "pci_addr=", 9)) {
        addr += 9;
    }
    if (pci_parse_devaddr(addr, domp, busp, slotp)) {
        monitor_printf(mon, "Invalid pci address\n");
266
        return -1;
267 268
    }
    return 0;
269 270
}

271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288
static PCIBus *pci_get_bus_devfn(int *devfnp, const char *devaddr)
{
    int dom, bus;
    unsigned slot;

    if (!devaddr) {
        *devfnp = -1;
        return pci_find_bus(0);
    }

    if (pci_parse_devaddr(devaddr, &dom, &bus, &slot) < 0) {
        return NULL;
    }

    *devfnp = slot << 3;
    return pci_find_bus(bus);
}

289 290 291 292 293 294 295 296 297 298 299 300
static void pci_init_cmask(PCIDevice *dev)
{
    pci_set_word(dev->cmask + PCI_VENDOR_ID, 0xffff);
    pci_set_word(dev->cmask + PCI_DEVICE_ID, 0xffff);
    dev->cmask[PCI_STATUS] = PCI_STATUS_CAP_LIST;
    dev->cmask[PCI_REVISION_ID] = 0xff;
    dev->cmask[PCI_CLASS_PROG] = 0xff;
    pci_set_word(dev->cmask + PCI_CLASS_DEVICE, 0xffff);
    dev->cmask[PCI_HEADER_TYPE] = 0xff;
    dev->cmask[PCI_CAPABILITY_LIST] = 0xff;
}

301 302 303 304 305 306 307 308 309 310 311
static void pci_init_wmask(PCIDevice *dev)
{
    int i;
    dev->wmask[PCI_CACHE_LINE_SIZE] = 0xff;
    dev->wmask[PCI_INTERRUPT_LINE] = 0xff;
    dev->wmask[PCI_COMMAND] = PCI_COMMAND_IO | PCI_COMMAND_MEMORY
                              | PCI_COMMAND_MASTER;
    for (i = PCI_CONFIG_HEADER_SIZE; i < PCI_CONFIG_SPACE_SIZE; ++i)
        dev->wmask[i] = 0xff;
}

bellard's avatar
bellard committed
312
/* -1 for devfn means auto assign */
Paul Brook's avatar
Paul Brook committed
313 314 315 316
static PCIDevice *do_pci_register_device(PCIDevice *pci_dev, PCIBus *bus,
                                         const char *name, int devfn,
                                         PCIConfigReadFunc *config_read,
                                         PCIConfigWriteFunc *config_write)
bellard's avatar
bellard committed
317 318
{
    if (devfn < 0) {
319 320
        for(devfn = bus->devfn_min ; devfn < 256; devfn += 8) {
            if (!bus->devices[devfn])
bellard's avatar
bellard committed
321 322 323 324
                goto found;
        }
        return NULL;
    found: ;
325 326
    } else if (bus->devices[devfn]) {
        return NULL;
bellard's avatar
bellard committed
327
    }
328
    pci_dev->bus = bus;
bellard's avatar
bellard committed
329 330
    pci_dev->devfn = devfn;
    pstrcpy(pci_dev->name, sizeof(pci_dev->name), name);
331
    memset(pci_dev->irq_state, 0, sizeof(pci_dev->irq_state));
332
    pci_set_default_subsystem_id(pci_dev);
333
    pci_init_cmask(pci_dev);
334
    pci_init_wmask(pci_dev);
335 336 337 338 339

    if (!config_read)
        config_read = pci_default_read_config;
    if (!config_write)
        config_write = pci_default_write_config;
bellard's avatar
bellard committed
340 341
    pci_dev->config_read = config_read;
    pci_dev->config_write = config_write;
342
    bus->devices[devfn] = pci_dev;
pbrook's avatar
pbrook committed
343
    pci_dev->irq = qemu_allocate_irqs(pci_set_irq, pci_dev, 4);
bellard's avatar
bellard committed
344 345 346
    return pci_dev;
}

Paul Brook's avatar
Paul Brook committed
347 348 349 350 351 352 353 354 355 356 357 358
PCIDevice *pci_register_device(PCIBus *bus, const char *name,
                               int instance_size, int devfn,
                               PCIConfigReadFunc *config_read,
                               PCIConfigWriteFunc *config_write)
{
    PCIDevice *pci_dev;

    pci_dev = qemu_mallocz(instance_size);
    pci_dev = do_pci_register_device(pci_dev, bus, name, devfn,
                                     config_read, config_write);
    return pci_dev;
}
359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395
static target_phys_addr_t pci_to_cpu_addr(target_phys_addr_t addr)
{
    return addr + pci_mem_base;
}

static void pci_unregister_io_regions(PCIDevice *pci_dev)
{
    PCIIORegion *r;
    int i;

    for(i = 0; i < PCI_NUM_REGIONS; i++) {
        r = &pci_dev->io_regions[i];
        if (!r->size || r->addr == -1)
            continue;
        if (r->type == PCI_ADDRESS_SPACE_IO) {
            isa_unassign_ioport(r->addr, r->size);
        } else {
            cpu_register_physical_memory(pci_to_cpu_addr(r->addr),
                                                     r->size,
                                                     IO_MEM_UNASSIGNED);
        }
    }
}

int pci_unregister_device(PCIDevice *pci_dev)
{
    int ret = 0;

    if (pci_dev->unregister)
        ret = pci_dev->unregister(pci_dev);
    if (ret)
        return ret;

    pci_unregister_io_regions(pci_dev);

    qemu_free_irqs(pci_dev->irq);
    pci_dev->bus->devices[pci_dev->devfn] = NULL;
Paul Brook's avatar
Paul Brook committed
396
    qdev_free(&pci_dev->qdev);
397 398 399
    return 0;
}

400
void pci_register_bar(PCIDevice *pci_dev, int region_num,
401
                            uint32_t size, int type,
bellard's avatar
bellard committed
402 403 404
                            PCIMapIORegionFunc *map_func)
{
    PCIIORegion *r;
pbrook's avatar
pbrook committed
405
    uint32_t addr;
406
    uint32_t wmask;
bellard's avatar
bellard committed
407

408
    if ((unsigned int)region_num >= PCI_NUM_REGIONS)
bellard's avatar
bellard committed
409
        return;
410 411 412 413 414 415 416

    if (size & (size-1)) {
        fprintf(stderr, "ERROR: PCI region size must be pow2 "
                    "type=0x%x, size=0x%x\n", type, size);
        exit(1);
    }

bellard's avatar
bellard committed
417 418 419 420 421
    r = &pci_dev->io_regions[region_num];
    r->addr = -1;
    r->size = size;
    r->type = type;
    r->map_func = map_func;
422 423

    wmask = ~(size - 1);
pbrook's avatar
pbrook committed
424 425
    if (region_num == PCI_ROM_SLOT) {
        addr = 0x30;
426 427
        /* ROM enable bit is writeable */
        wmask |= 1;
pbrook's avatar
pbrook committed
428 429 430 431
    } else {
        addr = 0x10 + region_num * 4;
    }
    *(uint32_t *)(pci_dev->config + addr) = cpu_to_le32(type);
432
    *(uint32_t *)(pci_dev->wmask + addr) = cpu_to_le32(wmask);
433
    *(uint32_t *)(pci_dev->cmask + addr) = 0xffffffff;
bellard's avatar
bellard committed
434 435
}

436 437 438 439
static void pci_update_mappings(PCIDevice *d)
{
    PCIIORegion *r;
    int cmd, i;
440
    uint32_t last_addr, new_addr, config_ofs;
441

442
    cmd = le16_to_cpu(*(uint16_t *)(d->config + PCI_COMMAND));
443
    for(i = 0; i < PCI_NUM_REGIONS; i++) {
444
        r = &d->io_regions[i];
445 446 447 448 449
        if (i == PCI_ROM_SLOT) {
            config_ofs = 0x30;
        } else {
            config_ofs = 0x10 + i * 4;
        }
450 451 452
        if (r->size != 0) {
            if (r->type & PCI_ADDRESS_SPACE_IO) {
                if (cmd & PCI_COMMAND_IO) {
453
                    new_addr = le32_to_cpu(*(uint32_t *)(d->config +
454
                                                         config_ofs));
455 456 457 458 459 460 461 462 463 464 465 466
                    new_addr = new_addr & ~(r->size - 1);
                    last_addr = new_addr + r->size - 1;
                    /* NOTE: we have only 64K ioports on PC */
                    if (last_addr <= new_addr || new_addr == 0 ||
                        last_addr >= 0x10000) {
                        new_addr = -1;
                    }
                } else {
                    new_addr = -1;
                }
            } else {
                if (cmd & PCI_COMMAND_MEMORY) {
467
                    new_addr = le32_to_cpu(*(uint32_t *)(d->config +
468 469 470 471
                                                         config_ofs));
                    /* the ROM slot has a specific enable bit */
                    if (i == PCI_ROM_SLOT && !(new_addr & 1))
                        goto no_mem_map;
472 473 474 475 476 477 478 479 480 481 482
                    new_addr = new_addr & ~(r->size - 1);
                    last_addr = new_addr + r->size - 1;
                    /* NOTE: we do not support wrapping */
                    /* XXX: as we cannot support really dynamic
                       mappings, we handle specific values as invalid
                       mappings. */
                    if (last_addr <= new_addr || new_addr == 0 ||
                        last_addr == -1) {
                        new_addr = -1;
                    }
                } else {
483
                no_mem_map:
484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500
                    new_addr = -1;
                }
            }
            /* now do the real mapping */
            if (new_addr != r->addr) {
                if (r->addr != -1) {
                    if (r->type & PCI_ADDRESS_SPACE_IO) {
                        int class;
                        /* NOTE: specific hack for IDE in PC case:
                           only one byte must be mapped. */
                        class = d->config[0x0a] | (d->config[0x0b] << 8);
                        if (class == 0x0101 && r->size == 4) {
                            isa_unassign_ioport(r->addr + 2, 1);
                        } else {
                            isa_unassign_ioport(r->addr, r->size);
                        }
                    } else {
pbrook's avatar
pbrook committed
501
                        cpu_register_physical_memory(pci_to_cpu_addr(r->addr),
502
                                                     r->size,
503
                                                     IO_MEM_UNASSIGNED);
aliguori's avatar
aliguori committed
504
                        qemu_unregister_coalesced_mmio(r->addr, r->size);
505 506 507 508 509 510 511 512 513 514 515
                    }
                }
                r->addr = new_addr;
                if (r->addr != -1) {
                    r->map_func(d, i, r->addr, r->size, r->type);
                }
            }
        }
    }
}

516
uint32_t pci_default_read_config(PCIDevice *d,
517
                                 uint32_t address, int len)
bellard's avatar
bellard committed
518
{
519
    uint32_t val;
520

521 522 523
    switch(len) {
    default:
    case 4:
524 525 526 527 528 529 530 531 532 533 534 535 536
	if (address <= 0xfc) {
	    val = le32_to_cpu(*(uint32_t *)(d->config + address));
	    break;
	}
	/* fall through */
    case 2:
        if (address <= 0xfe) {
	    val = le16_to_cpu(*(uint16_t *)(d->config + address));
	    break;
	}
	/* fall through */
    case 1:
        val = d->config[address];
537 538 539 540 541
        break;
    }
    return val;
}

542
void pci_default_write_config(PCIDevice *d, uint32_t addr, uint32_t val, int l)
543
{
544 545
    uint8_t orig[PCI_CONFIG_SPACE_SIZE];
    int i;
546 547

    /* not efficient, but simple */
548 549 550 551
    memcpy(orig, d->config, PCI_CONFIG_SPACE_SIZE);
    for(i = 0; i < l && addr < PCI_CONFIG_SPACE_SIZE; val >>= 8, ++i, ++addr) {
        uint8_t wmask = d->wmask[addr];
        d->config[addr] = (d->config[addr] & ~wmask) | (val & wmask);
552
    }
553 554 555
    if (memcmp(orig + PCI_BASE_ADDRESS_0, d->config + PCI_BASE_ADDRESS_0, 24)
        || ((orig[PCI_COMMAND] ^ d->config[PCI_COMMAND])
            & (PCI_COMMAND_MEMORY | PCI_COMMAND_IO)))
556
        pci_update_mappings(d);
bellard's avatar
bellard committed
557 558
}

pbrook's avatar
pbrook committed
559
void pci_data_write(void *opaque, uint32_t addr, uint32_t val, int len)
bellard's avatar
bellard committed
560
{
561 562 563
    PCIBus *s = opaque;
    PCIDevice *pci_dev;
    int config_addr, bus_num;
564

565 566 567
#if 0
    PCI_DPRINTF("pci_data_write: addr=%08x val=%08x len=%d\n",
                addr, val, len);
bellard's avatar
bellard committed
568
#endif
pbrook's avatar
pbrook committed
569
    bus_num = (addr >> 16) & 0xff;
pbrook's avatar
pbrook committed
570 571 572
    while (s && s->bus_num != bus_num)
        s = s->next;
    if (!s)
bellard's avatar
bellard committed
573
        return;
pbrook's avatar
pbrook committed
574
    pci_dev = s->devices[(addr >> 8) & 0xff];
bellard's avatar
bellard committed
575 576
    if (!pci_dev)
        return;
pbrook's avatar
pbrook committed
577
    config_addr = addr & 0xff;
578 579
    PCI_DPRINTF("pci_config_write: %s: addr=%02x val=%08x len=%d\n",
                pci_dev->name, config_addr, val, len);
580
    pci_dev->config_write(pci_dev, config_addr, val, len);
bellard's avatar
bellard committed
581 582
}

pbrook's avatar
pbrook committed
583
uint32_t pci_data_read(void *opaque, uint32_t addr, int len)
bellard's avatar
bellard committed
584
{
585 586 587
    PCIBus *s = opaque;
    PCIDevice *pci_dev;
    int config_addr, bus_num;
bellard's avatar
bellard committed
588 589
    uint32_t val;

pbrook's avatar
pbrook committed
590
    bus_num = (addr >> 16) & 0xff;
pbrook's avatar
pbrook committed
591 592 593
    while (s && s->bus_num != bus_num)
        s= s->next;
    if (!s)
bellard's avatar
bellard committed
594
        goto fail;
pbrook's avatar
pbrook committed
595
    pci_dev = s->devices[(addr >> 8) & 0xff];
bellard's avatar
bellard committed
596 597
    if (!pci_dev) {
    fail:
598 599 600 601 602 603 604 605 606 607 608 609
        switch(len) {
        case 1:
            val = 0xff;
            break;
        case 2:
            val = 0xffff;
            break;
        default:
        case 4:
            val = 0xffffffff;
            break;
        }
bellard's avatar
bellard committed
610 611
        goto the_end;
    }
pbrook's avatar
pbrook committed
612
    config_addr = addr & 0xff;
bellard's avatar
bellard committed
613
    val = pci_dev->config_read(pci_dev, config_addr, len);
614 615
    PCI_DPRINTF("pci_config_read: %s: addr=%02x val=%08x len=%d\n",
                pci_dev->name, config_addr, val, len);
bellard's avatar
bellard committed
616
 the_end:
617 618 619
#if 0
    PCI_DPRINTF("pci_data_read: addr=%08x val=%08x len=%d\n",
                addr, val, len);
bellard's avatar
bellard committed
620 621 622 623
#endif
    return val;
}

pbrook's avatar
pbrook committed
624 625
/***********************************************************/
/* generic PCI irq support */
626

pbrook's avatar
pbrook committed
627
/* 0 <= irq_num <= 3. level must be 0 or 1 */
pbrook's avatar
pbrook committed
628
static void pci_set_irq(void *opaque, int irq_num, int level)
bellard's avatar
bellard committed
629
{
pbrook's avatar
pbrook committed
630
    PCIDevice *pci_dev = (PCIDevice *)opaque;
pbrook's avatar
pbrook committed
631 632
    PCIBus *bus;
    int change;
633

pbrook's avatar
pbrook committed
634 635 636
    change = level - pci_dev->irq_state[irq_num];
    if (!change)
        return;
637 638

    pci_dev->irq_state[irq_num] = level;
pbrook's avatar
pbrook committed
639 640
    for (;;) {
        bus = pci_dev->bus;
pbrook's avatar
pbrook committed
641
        irq_num = bus->map_irq(pci_dev, irq_num);
pbrook's avatar
pbrook committed
642 643
        if (bus->set_irq)
            break;
pbrook's avatar
pbrook committed
644 645 646
        pci_dev = bus->parent_dev;
    }
    bus->irq_count[irq_num] += change;
647
    bus->set_irq(bus->irq_opaque, irq_num, bus->irq_count[irq_num] != 0);
bellard's avatar
bellard committed
648 649
}

pbrook's avatar
pbrook committed
650 651
/***********************************************************/
/* monitor info on PCI */
652

653 654 655 656 657
typedef struct {
    uint16_t class;
    const char *desc;
} pci_class_desc;

658
static const pci_class_desc pci_class_descriptions[] =
659
{
pbrook's avatar
pbrook committed
660
    { 0x0100, "SCSI controller"},
661
    { 0x0101, "IDE controller"},
ths's avatar
ths committed
662 663 664 665 666 667
    { 0x0102, "Floppy controller"},
    { 0x0103, "IPI controller"},
    { 0x0104, "RAID controller"},
    { 0x0106, "SATA controller"},
    { 0x0107, "SAS controller"},
    { 0x0180, "Storage controller"},
668
    { 0x0200, "Ethernet controller"},
ths's avatar
ths committed
669 670 671 672
    { 0x0201, "Token Ring controller"},
    { 0x0202, "FDDI controller"},
    { 0x0203, "ATM controller"},
    { 0x0280, "Network controller"},
673
    { 0x0300, "VGA controller"},
ths's avatar
ths committed
674 675 676 677 678 679 680 681 682 683
    { 0x0301, "XGA controller"},
    { 0x0302, "3D controller"},
    { 0x0380, "Display controller"},
    { 0x0400, "Video controller"},
    { 0x0401, "Audio controller"},
    { 0x0402, "Phone"},
    { 0x0480, "Multimedia controller"},
    { 0x0500, "RAM controller"},
    { 0x0501, "Flash controller"},
    { 0x0580, "Memory controller"},
684 685
    { 0x0600, "Host bridge"},
    { 0x0601, "ISA bridge"},
ths's avatar
ths committed
686 687
    { 0x0602, "EISA bridge"},
    { 0x0603, "MC bridge"},
688
    { 0x0604, "PCI bridge"},
ths's avatar
ths committed
689 690 691 692 693
    { 0x0605, "PCMCIA bridge"},
    { 0x0606, "NUBUS bridge"},
    { 0x0607, "CARDBUS bridge"},
    { 0x0608, "RACEWAY bridge"},
    { 0x0680, "Bridge"},
694 695 696 697
    { 0x0c03, "USB controller"},
    { 0, NULL}
};

pbrook's avatar
pbrook committed
698
static void pci_info_device(PCIDevice *d)
699
{
aliguori's avatar
aliguori committed
700
    Monitor *mon = cur_mon;
pbrook's avatar
pbrook committed
701 702
    int i, class;
    PCIIORegion *r;
703
    const pci_class_desc *desc;
704

aliguori's avatar
aliguori committed
705 706
    monitor_printf(mon, "  Bus %2d, device %3d, function %d:\n",
                   d->bus->bus_num, d->devfn >> 3, d->devfn & 7);
pbrook's avatar
pbrook committed
707
    class = le16_to_cpu(*((uint16_t *)(d->config + PCI_CLASS_DEVICE)));
aliguori's avatar
aliguori committed
708
    monitor_printf(mon, "    ");
709 710 711 712
    desc = pci_class_descriptions;
    while (desc->desc && class != desc->class)
        desc++;
    if (desc->desc) {
aliguori's avatar
aliguori committed
713
        monitor_printf(mon, "%s", desc->desc);
714
    } else {
aliguori's avatar
aliguori committed
715
        monitor_printf(mon, "Class %04x", class);
716
    }
aliguori's avatar
aliguori committed
717
    monitor_printf(mon, ": PCI device %04x:%04x\n",
pbrook's avatar
pbrook committed
718 719
           le16_to_cpu(*((uint16_t *)(d->config + PCI_VENDOR_ID))),
           le16_to_cpu(*((uint16_t *)(d->config + PCI_DEVICE_ID))));
720

pbrook's avatar
pbrook committed
721
    if (d->config[PCI_INTERRUPT_PIN] != 0) {
aliguori's avatar
aliguori committed
722 723
        monitor_printf(mon, "      IRQ %d.\n",
                       d->config[PCI_INTERRUPT_LINE]);
724
    }
pbrook's avatar
pbrook committed
725
    if (class == 0x0604) {
aliguori's avatar
aliguori committed
726
        monitor_printf(mon, "      BUS %d.\n", d->config[0x19]);
pbrook's avatar
pbrook committed
727
    }
pbrook's avatar
pbrook committed
728 729 730
    for(i = 0;i < PCI_NUM_REGIONS; i++) {
        r = &d->io_regions[i];
        if (r->size != 0) {
aliguori's avatar
aliguori committed
731
            monitor_printf(mon, "      BAR%d: ", i);
pbrook's avatar
pbrook committed
732
            if (r->type & PCI_ADDRESS_SPACE_IO) {
aliguori's avatar
aliguori committed
733 734
                monitor_printf(mon, "I/O at 0x%04x [0x%04x].\n",
                               r->addr, r->addr + r->size - 1);
pbrook's avatar
pbrook committed
735
            } else {
aliguori's avatar
aliguori committed
736 737
                monitor_printf(mon, "32 bit memory at 0x%08x [0x%08x].\n",
                               r->addr, r->addr + r->size - 1);
pbrook's avatar
pbrook committed
738 739
            }
        }
bellard's avatar
bellard committed
740
    }
741
    monitor_printf(mon, "      id \"%s\"\n", d->qdev.id ? d->qdev.id : "");
pbrook's avatar
pbrook committed
742 743 744
    if (class == 0x0604 && d->config[0x19] != 0) {
        pci_for_each_device(d->config[0x19], pci_info_device);
    }
745 746
}

pbrook's avatar
pbrook committed
747
void pci_for_each_device(int bus_num, void (*fn)(PCIDevice *d))
748
{
pbrook's avatar
pbrook committed
749
    PCIBus *bus = first_bus;
750
    PCIDevice *d;
pbrook's avatar
pbrook committed
751
    int devfn;
752

pbrook's avatar
pbrook committed
753 754
    while (bus && bus->bus_num != bus_num)
        bus = bus->next;
pbrook's avatar
pbrook committed
755 756 757 758 759 760
    if (bus) {
        for(devfn = 0; devfn < 256; devfn++) {
            d = bus->devices[devfn];
            if (d)
                fn(d);
        }
bellard's avatar
bellard committed
761 762 763
    }
}

aliguori's avatar
aliguori committed
764
void pci_info(Monitor *mon)
bellard's avatar
bellard committed
765
{
pbrook's avatar
pbrook committed
766
    pci_for_each_device(0, pci_info_device);
bellard's avatar
bellard committed
767
}
768

769
PCIDevice *pci_create(const char *name, const char *devaddr)
770 771 772 773 774 775 776 777 778 779 780 781 782
{
    PCIBus *bus;
    int devfn;
    DeviceState *dev;

    bus = pci_get_bus_devfn(&devfn, devaddr);
    if (!bus) {
        fprintf(stderr, "Invalid PCI device address %s for device %s\n",
                devaddr, name);
        exit(1);
    }

    dev = qdev_create(&bus->qbus, name);
783
    qdev_prop_set_uint32(dev, "devfn", devfn);
784 785 786
    return (PCIDevice *)dev;
}

787 788 789 790 791 792 793 794 795 796 797 798
static const char * const pci_nic_models[] = {
    "ne2k_pci",
    "i82551",
    "i82557b",
    "i82559er",
    "rtl8139",
    "e1000",
    "pcnet",
    "virtio",
    NULL
};

Paul Brook's avatar
Paul Brook committed
799 800 801 802 803 804 805 806
static const char * const pci_nic_names[] = {
    "ne2k_pci",
    "i82551",
    "i82557b",
    "i82559er",
    "rtl8139",
    "e1000",
    "pcnet",
Paul Brook's avatar
Paul Brook committed
807
    "virtio-net-pci",
808 809 810
    NULL
};

811
/* Initialize a PCI NIC.  */
812 813
PCIDevice *pci_nic_init(NICInfo *nd, const char *default_model,
                        const char *default_devaddr)
814
{
815 816
    const char *devaddr = nd->devaddr ? nd->devaddr : default_devaddr;
    PCIDevice *pci_dev;
Paul Brook's avatar
Paul Brook committed
817
    DeviceState *dev;
818 819 820 821
    int i;

    qemu_check_nic_model_list(nd, pci_nic_models, default_model);

Paul Brook's avatar
Paul Brook committed
822
    for (i = 0; pci_nic_models[i]; i++) {
823
        if (strcmp(nd->model, pci_nic_models[i]) == 0) {
824 825
            pci_dev = pci_create(pci_nic_names[i], devaddr);
            dev = &pci_dev->qdev;
826 827
            if (nd->id)
                dev->id = qemu_strdup(nd->id);
828
            dev->nd = nd;
Paul Brook's avatar
Paul Brook committed
829 830
            qdev_init(dev);
            nd->private = dev;
831
            return pci_dev;
832
        }
Paul Brook's avatar
Paul Brook committed
833
    }
834 835

    return NULL;
836 837
}

pbrook's avatar
pbrook committed
838 839 840 841 842
typedef struct {
    PCIDevice dev;
    PCIBus *bus;
} PCIBridge;

843
static void pci_bridge_write_config(PCIDevice *d,
pbrook's avatar
pbrook committed
844 845 846 847 848
                             uint32_t address, uint32_t val, int len)
{
    PCIBridge *s = (PCIBridge *)d;

    pci_default_write_config(d, address, val, len);
849
    s->bus->bus_num = d->config[PCI_SECONDARY_BUS];
pbrook's avatar
pbrook committed
850 851
}

852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871
PCIBus *pci_find_bus(int bus_num)
{
    PCIBus *bus = first_bus;

    while (bus && bus->bus_num != bus_num)
        bus = bus->next;

    return bus;
}

PCIDevice *pci_find_device(int bus_num, int slot, int function)
{
    PCIBus *bus = pci_find_bus(bus_num);

    if (!bus)
        return NULL;

    return bus->devices[PCI_DEVFN(slot, function)];
}

blueswir1's avatar
blueswir1 committed
872
PCIBus *pci_bridge_init(PCIBus *bus, int devfn, uint16_t vid, uint16_t did,
pbrook's avatar
pbrook committed
873 874 875
                        pci_map_irq_fn map_irq, const char *name)
{
    PCIBridge *s;
876
    s = (PCIBridge *)pci_register_device(bus, name, sizeof(PCIBridge),
pbrook's avatar
pbrook committed
877
                                         devfn, NULL, pci_bridge_write_config);
blueswir1's avatar
blueswir1 committed
878 879 880 881

    pci_config_set_vendor_id(s->dev.config, vid);
    pci_config_set_device_id(s->dev.config, did);

pbrook's avatar
pbrook committed
882 883 884 885 886 887
    s->dev.config[0x04] = 0x06; // command = bus master, pci mem
    s->dev.config[0x05] = 0x00;
    s->dev.config[0x06] = 0xa0; // status = fast back-to-back, 66MHz, no error
    s->dev.config[0x07] = 0x00; // status = fast devsel
    s->dev.config[0x08] = 0x00; // revision
    s->dev.config[0x09] = 0x00; // programming i/f
888
    pci_config_set_class(s->dev.config, PCI_CLASS_BRIDGE_PCI);
pbrook's avatar
pbrook committed
889
    s->dev.config[0x0D] = 0x10; // latency_timer
Isaku Yamahata's avatar
Isaku Yamahata committed
890 891
    s->dev.config[PCI_HEADER_TYPE] =
        PCI_HEADER_TYPE_MULTI_FUNCTION | PCI_HEADER_TYPE_BRIDGE; // header_type
pbrook's avatar
pbrook committed
892 893 894 895 896
    s->dev.config[0x1E] = 0xa0; // secondary status

    s->bus = pci_register_secondary_bus(&s->dev, map_irq);
    return s->bus;
}
Paul Brook's avatar
Paul Brook committed
897

Paul Brook's avatar
Paul Brook committed
898
static void pci_qdev_init(DeviceState *qdev, DeviceInfo *base)
Paul Brook's avatar
Paul Brook committed
899 900
{
    PCIDevice *pci_dev = (PCIDevice *)qdev;
Paul Brook's avatar
Paul Brook committed
901
    PCIDeviceInfo *info = container_of(base, PCIDeviceInfo, qdev);
Paul Brook's avatar
Paul Brook committed
902 903 904
    PCIBus *bus;
    int devfn;

Paul Brook's avatar
Paul Brook committed
905
    bus = FROM_QBUS(PCIBus, qdev_get_parent_bus(qdev));
906
    devfn = pci_dev->devfn;
Gerd Hoffmann's avatar
Gerd Hoffmann committed
907
    pci_dev = do_pci_register_device(pci_dev, bus, base->name, devfn,
908
                                     info->config_read, info->config_write);
Paul Brook's avatar
Paul Brook committed
909
    assert(pci_dev);
Paul Brook's avatar
Paul Brook committed
910
    info->init(pci_dev);
Paul Brook's avatar
Paul Brook committed
911 912
}

913
void pci_qdev_register(PCIDeviceInfo *info)
Paul Brook's avatar
Paul Brook committed
914
{
Paul Brook's avatar
Paul Brook committed
915
    info->qdev.init = pci_qdev_init;
916
    info->qdev.bus_info = &pci_bus_info;
917
    qdev_register(&info->qdev);
Paul Brook's avatar
Paul Brook committed
918 919
}

920 921 922 923 924 925 926 927
void pci_qdev_register_many(PCIDeviceInfo *info)
{
    while (info->qdev.name) {
        pci_qdev_register(info);
        info++;
    }
}

Paul Brook's avatar
Paul Brook committed
928 929 930 931
PCIDevice *pci_create_simple(PCIBus *bus, int devfn, const char *name)
{
    DeviceState *dev;

Paul Brook's avatar
Paul Brook committed
932
    dev = qdev_create(&bus->qbus, name);
933
    qdev_prop_set_uint32(dev, "devfn", devfn);
Paul Brook's avatar
Paul Brook committed
934 935 936 937
    qdev_init(dev);

    return (PCIDevice *)dev;
}
938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982

static int pci_find_space(PCIDevice *pdev, uint8_t size)
{
    int offset = PCI_CONFIG_HEADER_SIZE;
    int i;
    for (i = PCI_CONFIG_HEADER_SIZE; i < PCI_CONFIG_SPACE_SIZE; ++i)
        if (pdev->used[i])
            offset = i + 1;
        else if (i - offset + 1 == size)
            return offset;
    return 0;
}

static uint8_t pci_find_capability_list(PCIDevice *pdev, uint8_t cap_id,
                                        uint8_t *prev_p)
{
    uint8_t next, prev;

    if (!(pdev->config[PCI_STATUS] & PCI_STATUS_CAP_LIST))
        return 0;

    for (prev = PCI_CAPABILITY_LIST; (next = pdev->config[prev]);
         prev = next + PCI_CAP_LIST_NEXT)
        if (pdev->config[next + PCI_CAP_LIST_ID] == cap_id)
            break;

    if (prev_p)
        *prev_p = prev;
    return next;
}

/* Reserve space and add capability to the linked list in pci config space */
int pci_add_capability(PCIDevice *pdev, uint8_t cap_id, uint8_t size)
{
    uint8_t offset = pci_find_space(pdev, size);
    uint8_t *config = pdev->config + offset;
    if (!offset)
        return -ENOSPC;
    config[PCI_CAP_LIST_ID] = cap_id;
    config[PCI_CAP_LIST_NEXT] = pdev->config[PCI_CAPABILITY_LIST];
    pdev->config[PCI_CAPABILITY_LIST] = offset;
    pdev->config[PCI_STATUS] |= PCI_STATUS_CAP_LIST;
    memset(pdev->used + offset, 0xFF, size);
    /* Make capability read-only by default */
    memset(pdev->wmask + offset, 0, size);
983 984
    /* Check capability by default */
    memset(pdev->cmask + offset, 0xFF, size);
985 986 987 988 989 990 991 992 993 994 995 996