Statistics
| Branch: | Revision:

root / hw / pci.c @ 776e1bbb

History | View | Annotate | Download (55.4 kB)

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

    
32
//#define DEBUG_PCI
33
#ifdef DEBUG_PCI
34
# define PCI_DPRINTF(format, ...)       printf(format, ## __VA_ARGS__)
35
#else
36
# define PCI_DPRINTF(format, ...)       do { } while (0)
37
#endif
38

    
39
struct PCIBus {
40
    BusState qbus;
41
    int devfn_min;
42
    pci_set_irq_fn set_irq;
43
    pci_map_irq_fn map_irq;
44
    pci_hotplug_fn hotplug;
45
    void *irq_opaque;
46
    PCIDevice *devices[256];
47
    PCIDevice *parent_dev;
48
    target_phys_addr_t mem_base;
49

    
50
    QLIST_HEAD(, PCIBus) child; /* this will be replaced by qdev later */
51
    QLIST_ENTRY(PCIBus) sibling;/* this will be replaced by qdev later */
52

    
53
    /* The bus IRQ state is the logical OR of the connected devices.
54
       Keep a count of the number of devices with raised IRQs.  */
55
    int nirq;
56
    int *irq_count;
57
};
58

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

    
61
static struct BusInfo pci_bus_info = {
62
    .name       = "PCI",
63
    .size       = sizeof(PCIBus),
64
    .print_dev  = pcibus_dev_print,
65
    .props      = (Property[]) {
66
        DEFINE_PROP_PCI_DEVFN("addr", PCIDevice, devfn, -1),
67
        DEFINE_PROP_STRING("romfile", PCIDevice, romfile),
68
        DEFINE_PROP_UINT32("rombar",  PCIDevice, rom_bar, 1),
69
        DEFINE_PROP_END_OF_LIST()
70
    }
71
};
72

    
73
static void pci_update_mappings(PCIDevice *d);
74
static void pci_set_irq(void *opaque, int irq_num, int level);
75
static int pci_add_option_rom(PCIDevice *pdev);
76

    
77
static uint16_t pci_default_sub_vendor_id = PCI_SUBVENDOR_ID_REDHAT_QUMRANET;
78
static uint16_t pci_default_sub_device_id = PCI_SUBDEVICE_ID_QEMU;
79

    
80
struct PCIHostBus {
81
    int domain;
82
    struct PCIBus *bus;
83
    QLIST_ENTRY(PCIHostBus) next;
84
};
85
static QLIST_HEAD(, PCIHostBus) host_buses;
86

    
87
static const VMStateDescription vmstate_pcibus = {
88
    .name = "PCIBUS",
89
    .version_id = 1,
90
    .minimum_version_id = 1,
91
    .minimum_version_id_old = 1,
92
    .fields      = (VMStateField []) {
93
        VMSTATE_INT32_EQUAL(nirq, PCIBus),
94
        VMSTATE_VARRAY_INT32(irq_count, PCIBus, nirq, 0, vmstate_info_int32, int32_t),
95
        VMSTATE_END_OF_LIST()
96
    }
97
};
98

    
99
static int pci_bar(PCIDevice *d, int reg)
100
{
101
    uint8_t type;
102

    
103
    if (reg != PCI_ROM_SLOT)
104
        return PCI_BASE_ADDRESS_0 + reg * 4;
105

    
106
    type = d->config[PCI_HEADER_TYPE] & ~PCI_HEADER_TYPE_MULTI_FUNCTION;
107
    return type == PCI_HEADER_TYPE_BRIDGE ? PCI_ROM_ADDRESS1 : PCI_ROM_ADDRESS;
108
}
109

    
110
static inline int pci_irq_state(PCIDevice *d, int irq_num)
111
{
112
        return (d->irq_state >> irq_num) & 0x1;
113
}
114

    
115
static inline void pci_set_irq_state(PCIDevice *d, int irq_num, int level)
116
{
117
        d->irq_state &= ~(0x1 << irq_num);
118
        d->irq_state |= level << irq_num;
119
}
120

    
121
static void pci_change_irq_level(PCIDevice *pci_dev, int irq_num, int change)
122
{
123
    PCIBus *bus;
124
    for (;;) {
125
        bus = pci_dev->bus;
126
        irq_num = bus->map_irq(pci_dev, irq_num);
127
        if (bus->set_irq)
128
            break;
129
        pci_dev = bus->parent_dev;
130
    }
131
    bus->irq_count[irq_num] += change;
132
    bus->set_irq(bus->irq_opaque, irq_num, bus->irq_count[irq_num] != 0);
133
}
134

    
135
/* Update interrupt status bit in config space on interrupt
136
 * state change. */
137
static void pci_update_irq_status(PCIDevice *dev)
138
{
139
    if (dev->irq_state) {
140
        dev->config[PCI_STATUS] |= PCI_STATUS_INTERRUPT;
141
    } else {
142
        dev->config[PCI_STATUS] &= ~PCI_STATUS_INTERRUPT;
143
    }
144
}
145

    
146
static void pci_device_reset(PCIDevice *dev)
147
{
148
    int r;
149

    
150
    dev->irq_state = 0;
151
    pci_update_irq_status(dev);
152
    dev->config[PCI_COMMAND] &= ~(PCI_COMMAND_IO | PCI_COMMAND_MEMORY |
153
                                  PCI_COMMAND_MASTER);
154
    dev->config[PCI_CACHE_LINE_SIZE] = 0x0;
155
    dev->config[PCI_INTERRUPT_LINE] = 0x0;
156
    for (r = 0; r < PCI_NUM_REGIONS; ++r) {
157
        if (!dev->io_regions[r].size) {
158
            continue;
159
        }
160
        pci_set_long(dev->config + pci_bar(dev, r), dev->io_regions[r].type);
161
    }
162
    pci_update_mappings(dev);
163
}
164

    
165
static void pci_bus_reset(void *opaque)
166
{
167
    PCIBus *bus = opaque;
168
    int i;
169

    
170
    for (i = 0; i < bus->nirq; i++) {
171
        bus->irq_count[i] = 0;
172
    }
173
    for (i = 0; i < ARRAY_SIZE(bus->devices); ++i) {
174
        if (bus->devices[i]) {
175
            pci_device_reset(bus->devices[i]);
176
        }
177
    }
178
}
179

    
180
static void pci_host_bus_register(int domain, PCIBus *bus)
181
{
182
    struct PCIHostBus *host;
183
    host = qemu_mallocz(sizeof(*host));
184
    host->domain = domain;
185
    host->bus = bus;
186
    QLIST_INSERT_HEAD(&host_buses, host, next);
187
}
188

    
189
PCIBus *pci_find_root_bus(int domain)
190
{
191
    struct PCIHostBus *host;
192

    
193
    QLIST_FOREACH(host, &host_buses, next) {
194
        if (host->domain == domain) {
195
            return host->bus;
196
        }
197
    }
198

    
199
    return NULL;
200
}
201

    
202
void pci_bus_new_inplace(PCIBus *bus, DeviceState *parent,
203
                         const char *name, int devfn_min)
204
{
205
    qbus_create_inplace(&bus->qbus, &pci_bus_info, parent, name);
206
    bus->devfn_min = devfn_min;
207

    
208
    /* host bridge */
209
    QLIST_INIT(&bus->child);
210
    pci_host_bus_register(0, bus); /* for now only pci domain 0 is supported */
211

    
212
    vmstate_register(-1, &vmstate_pcibus, bus);
213
    qemu_register_reset(pci_bus_reset, bus);
214
}
215

    
216
PCIBus *pci_bus_new(DeviceState *parent, const char *name, int devfn_min)
217
{
218
    PCIBus *bus;
219

    
220
    bus = qemu_mallocz(sizeof(*bus));
221
    bus->qbus.qdev_allocated = 1;
222
    pci_bus_new_inplace(bus, parent, name, devfn_min);
223
    return bus;
224
}
225

    
226
void pci_bus_irqs(PCIBus *bus, pci_set_irq_fn set_irq, pci_map_irq_fn map_irq,
227
                  void *irq_opaque, int nirq)
228
{
229
    bus->set_irq = set_irq;
230
    bus->map_irq = map_irq;
231
    bus->irq_opaque = irq_opaque;
232
    bus->nirq = nirq;
233
    bus->irq_count = qemu_mallocz(nirq * sizeof(bus->irq_count[0]));
234
}
235

    
236
void pci_bus_hotplug(PCIBus *bus, pci_hotplug_fn hotplug)
237
{
238
    bus->qbus.allow_hotplug = 1;
239
    bus->hotplug = hotplug;
240
}
241

    
242
void pci_bus_set_mem_base(PCIBus *bus, target_phys_addr_t base)
243
{
244
    bus->mem_base = base;
245
}
246

    
247
PCIBus *pci_register_bus(DeviceState *parent, const char *name,
248
                         pci_set_irq_fn set_irq, pci_map_irq_fn map_irq,
249
                         void *irq_opaque, int devfn_min, int nirq)
250
{
251
    PCIBus *bus;
252

    
253
    bus = pci_bus_new(parent, name, devfn_min);
254
    pci_bus_irqs(bus, set_irq, map_irq, irq_opaque, nirq);
255
    return bus;
256
}
257

    
258
static void pci_register_secondary_bus(PCIBus *parent,
259
                                       PCIBus *bus,
260
                                       PCIDevice *dev,
261
                                       pci_map_irq_fn map_irq,
262
                                       const char *name)
263
{
264
    qbus_create_inplace(&bus->qbus, &pci_bus_info, &dev->qdev, name);
265
    bus->map_irq = map_irq;
266
    bus->parent_dev = dev;
267

    
268
    QLIST_INIT(&bus->child);
269
    QLIST_INSERT_HEAD(&parent->child, bus, sibling);
270
}
271

    
272
static void pci_unregister_secondary_bus(PCIBus *bus)
273
{
274
    assert(QLIST_EMPTY(&bus->child));
275
    QLIST_REMOVE(bus, sibling);
276
}
277

    
278
int pci_bus_num(PCIBus *s)
279
{
280
    if (!s->parent_dev)
281
        return 0;       /* pci host bridge */
282
    return s->parent_dev->config[PCI_SECONDARY_BUS];
283
}
284

    
285
static int get_pci_config_device(QEMUFile *f, void *pv, size_t size)
286
{
287
    PCIDevice *s = container_of(pv, PCIDevice, config);
288
    uint8_t *config;
289
    int i;
290

    
291
    assert(size == pci_config_size(s));
292
    config = qemu_malloc(size);
293

    
294
    qemu_get_buffer(f, config, size);
295
    for (i = 0; i < size; ++i) {
296
        if ((config[i] ^ s->config[i]) & s->cmask[i] & ~s->wmask[i]) {
297
            qemu_free(config);
298
            return -EINVAL;
299
        }
300
    }
301
    memcpy(s->config, config, size);
302

    
303
    pci_update_mappings(s);
304

    
305
    qemu_free(config);
306
    return 0;
307
}
308

    
309
/* just put buffer */
310
static void put_pci_config_device(QEMUFile *f, void *pv, size_t size)
311
{
312
    const uint8_t **v = pv;
313
    assert(size == pci_config_size(container_of(pv, PCIDevice, config)));
314
    qemu_put_buffer(f, *v, size);
315
}
316

    
317
static VMStateInfo vmstate_info_pci_config = {
318
    .name = "pci config",
319
    .get  = get_pci_config_device,
320
    .put  = put_pci_config_device,
321
};
322

    
323
static int get_pci_irq_state(QEMUFile *f, void *pv, size_t size)
324
{
325
    PCIDevice *s = container_of(pv, PCIDevice, config);
326
    uint32_t irq_state[PCI_NUM_PINS];
327
    int i;
328
    for (i = 0; i < PCI_NUM_PINS; ++i) {
329
        irq_state[i] = qemu_get_be32(f);
330
        if (irq_state[i] != 0x1 && irq_state[i] != 0) {
331
            fprintf(stderr, "irq state %d: must be 0 or 1.\n",
332
                    irq_state[i]);
333
            return -EINVAL;
334
        }
335
    }
336

    
337
    for (i = 0; i < PCI_NUM_PINS; ++i) {
338
        pci_set_irq_state(s, i, irq_state[i]);
339
    }
340

    
341
    return 0;
342
}
343

    
344
static void put_pci_irq_state(QEMUFile *f, void *pv, size_t size)
345
{
346
    int i;
347
    PCIDevice *s = container_of(pv, PCIDevice, config);
348

    
349
    for (i = 0; i < PCI_NUM_PINS; ++i) {
350
        qemu_put_be32(f, pci_irq_state(s, i));
351
    }
352
}
353

    
354
static VMStateInfo vmstate_info_pci_irq_state = {
355
    .name = "pci irq state",
356
    .get  = get_pci_irq_state,
357
    .put  = put_pci_irq_state,
358
};
359

    
360
const VMStateDescription vmstate_pci_device = {
361
    .name = "PCIDevice",
362
    .version_id = 2,
363
    .minimum_version_id = 1,
364
    .minimum_version_id_old = 1,
365
    .fields      = (VMStateField []) {
366
        VMSTATE_INT32_LE(version_id, PCIDevice),
367
        VMSTATE_BUFFER_UNSAFE_INFO(config, PCIDevice, 0,
368
                                   vmstate_info_pci_config,
369
                                   PCI_CONFIG_SPACE_SIZE),
370
        VMSTATE_BUFFER_UNSAFE_INFO(irq_state, PCIDevice, 2,
371
                                   vmstate_info_pci_irq_state,
372
                                   PCI_NUM_PINS * sizeof(int32_t)),
373
        VMSTATE_END_OF_LIST()
374
    }
375
};
376

    
377
const VMStateDescription vmstate_pcie_device = {
378
    .name = "PCIDevice",
379
    .version_id = 2,
380
    .minimum_version_id = 1,
381
    .minimum_version_id_old = 1,
382
    .fields      = (VMStateField []) {
383
        VMSTATE_INT32_LE(version_id, PCIDevice),
384
        VMSTATE_BUFFER_UNSAFE_INFO(config, PCIDevice, 0,
385
                                   vmstate_info_pci_config,
386
                                   PCIE_CONFIG_SPACE_SIZE),
387
        VMSTATE_BUFFER_UNSAFE_INFO(irq_state, PCIDevice, 2,
388
                                   vmstate_info_pci_irq_state,
389
                                   PCI_NUM_PINS * sizeof(int32_t)),
390
        VMSTATE_END_OF_LIST()
391
    }
392
};
393

    
394
static inline const VMStateDescription *pci_get_vmstate(PCIDevice *s)
395
{
396
    return pci_is_express(s) ? &vmstate_pcie_device : &vmstate_pci_device;
397
}
398

    
399
void pci_device_save(PCIDevice *s, QEMUFile *f)
400
{
401
    /* Clear interrupt status bit: it is implicit
402
     * in irq_state which we are saving.
403
     * This makes us compatible with old devices
404
     * which never set or clear this bit. */
405
    s->config[PCI_STATUS] &= ~PCI_STATUS_INTERRUPT;
406
    vmstate_save_state(f, pci_get_vmstate(s), s);
407
    /* Restore the interrupt status bit. */
408
    pci_update_irq_status(s);
409
}
410

    
411
int pci_device_load(PCIDevice *s, QEMUFile *f)
412
{
413
    int ret;
414
    ret = vmstate_load_state(f, pci_get_vmstate(s), s, s->version_id);
415
    /* Restore the interrupt status bit. */
416
    pci_update_irq_status(s);
417
    return ret;
418
}
419

    
420
static int pci_set_default_subsystem_id(PCIDevice *pci_dev)
421
{
422
    uint16_t *id;
423

    
424
    id = (void*)(&pci_dev->config[PCI_SUBSYSTEM_VENDOR_ID]);
425
    id[0] = cpu_to_le16(pci_default_sub_vendor_id);
426
    id[1] = cpu_to_le16(pci_default_sub_device_id);
427
    return 0;
428
}
429

    
430
/*
431
 * Parse [[<domain>:]<bus>:]<slot>, return -1 on error
432
 */
433
static int pci_parse_devaddr(const char *addr, int *domp, int *busp, unsigned *slotp)
434
{
435
    const char *p;
436
    char *e;
437
    unsigned long val;
438
    unsigned long dom = 0, bus = 0;
439
    unsigned slot = 0;
440

    
441
    p = addr;
442
    val = strtoul(p, &e, 16);
443
    if (e == p)
444
        return -1;
445
    if (*e == ':') {
446
        bus = val;
447
        p = e + 1;
448
        val = strtoul(p, &e, 16);
449
        if (e == p)
450
            return -1;
451
        if (*e == ':') {
452
            dom = bus;
453
            bus = val;
454
            p = e + 1;
455
            val = strtoul(p, &e, 16);
456
            if (e == p)
457
                return -1;
458
        }
459
    }
460

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

    
464
    slot = val;
465

    
466
    if (*e)
467
        return -1;
468

    
469
    /* Note: QEMU doesn't implement domains other than 0 */
470
    if (!pci_find_bus(pci_find_root_bus(dom), bus))
471
        return -1;
472

    
473
    *domp = dom;
474
    *busp = bus;
475
    *slotp = slot;
476
    return 0;
477
}
478

    
479
int pci_read_devaddr(Monitor *mon, const char *addr, int *domp, int *busp,
480
                     unsigned *slotp)
481
{
482
    /* strip legacy tag */
483
    if (!strncmp(addr, "pci_addr=", 9)) {
484
        addr += 9;
485
    }
486
    if (pci_parse_devaddr(addr, domp, busp, slotp)) {
487
        monitor_printf(mon, "Invalid pci address\n");
488
        return -1;
489
    }
490
    return 0;
491
}
492

    
493
PCIBus *pci_get_bus_devfn(int *devfnp, const char *devaddr)
494
{
495
    int dom, bus;
496
    unsigned slot;
497

    
498
    if (!devaddr) {
499
        *devfnp = -1;
500
        return pci_find_bus(pci_find_root_bus(0), 0);
501
    }
502

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

    
507
    *devfnp = slot << 3;
508
    return pci_find_bus(pci_find_root_bus(0), bus);
509
}
510

    
511
static void pci_init_cmask(PCIDevice *dev)
512
{
513
    pci_set_word(dev->cmask + PCI_VENDOR_ID, 0xffff);
514
    pci_set_word(dev->cmask + PCI_DEVICE_ID, 0xffff);
515
    dev->cmask[PCI_STATUS] = PCI_STATUS_CAP_LIST;
516
    dev->cmask[PCI_REVISION_ID] = 0xff;
517
    dev->cmask[PCI_CLASS_PROG] = 0xff;
518
    pci_set_word(dev->cmask + PCI_CLASS_DEVICE, 0xffff);
519
    dev->cmask[PCI_HEADER_TYPE] = 0xff;
520
    dev->cmask[PCI_CAPABILITY_LIST] = 0xff;
521
}
522

    
523
static void pci_init_wmask(PCIDevice *dev)
524
{
525
    int config_size = pci_config_size(dev);
526

    
527
    dev->wmask[PCI_CACHE_LINE_SIZE] = 0xff;
528
    dev->wmask[PCI_INTERRUPT_LINE] = 0xff;
529
    pci_set_word(dev->wmask + PCI_COMMAND,
530
                 PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER |
531
                 PCI_COMMAND_INTX_DISABLE);
532

    
533
    memset(dev->wmask + PCI_CONFIG_HEADER_SIZE, 0xff,
534
           config_size - PCI_CONFIG_HEADER_SIZE);
535
}
536

    
537
static void pci_init_wmask_bridge(PCIDevice *d)
538
{
539
    /* PCI_PRIMARY_BUS, PCI_SECONDARY_BUS, PCI_SUBORDINATE_BUS and
540
       PCI_SEC_LETENCY_TIMER */
541
    memset(d->wmask + PCI_PRIMARY_BUS, 0xff, 4);
542

    
543
    /* base and limit */
544
    d->wmask[PCI_IO_BASE] = PCI_IO_RANGE_MASK & 0xff;
545
    d->wmask[PCI_IO_LIMIT] = PCI_IO_RANGE_MASK & 0xff;
546
    pci_set_word(d->wmask + PCI_MEMORY_BASE,
547
                 PCI_MEMORY_RANGE_MASK & 0xffff);
548
    pci_set_word(d->wmask + PCI_MEMORY_LIMIT,
549
                 PCI_MEMORY_RANGE_MASK & 0xffff);
550
    pci_set_word(d->wmask + PCI_PREF_MEMORY_BASE,
551
                 PCI_PREF_RANGE_MASK & 0xffff);
552
    pci_set_word(d->wmask + PCI_PREF_MEMORY_LIMIT,
553
                 PCI_PREF_RANGE_MASK & 0xffff);
554

    
555
    /* PCI_PREF_BASE_UPPER32 and PCI_PREF_LIMIT_UPPER32 */
556
    memset(d->wmask + PCI_PREF_BASE_UPPER32, 0xff, 8);
557

    
558
    pci_set_word(d->wmask + PCI_BRIDGE_CONTROL, 0xffff);
559
}
560

    
561
static void pci_config_alloc(PCIDevice *pci_dev)
562
{
563
    int config_size = pci_config_size(pci_dev);
564

    
565
    pci_dev->config = qemu_mallocz(config_size);
566
    pci_dev->cmask = qemu_mallocz(config_size);
567
    pci_dev->wmask = qemu_mallocz(config_size);
568
    pci_dev->used = qemu_mallocz(config_size);
569
}
570

    
571
static void pci_config_free(PCIDevice *pci_dev)
572
{
573
    qemu_free(pci_dev->config);
574
    qemu_free(pci_dev->cmask);
575
    qemu_free(pci_dev->wmask);
576
    qemu_free(pci_dev->used);
577
}
578

    
579
/* -1 for devfn means auto assign */
580
static PCIDevice *do_pci_register_device(PCIDevice *pci_dev, PCIBus *bus,
581
                                         const char *name, int devfn,
582
                                         PCIConfigReadFunc *config_read,
583
                                         PCIConfigWriteFunc *config_write,
584
                                         uint8_t header_type)
585
{
586
    if (devfn < 0) {
587
        for(devfn = bus->devfn_min ; devfn < ARRAY_SIZE(bus->devices);
588
            devfn += 8) {
589
            if (!bus->devices[devfn])
590
                goto found;
591
        }
592
        qemu_error("PCI: no devfn available for %s, all in use\n", name);
593
        return NULL;
594
    found: ;
595
    } else if (bus->devices[devfn]) {
596
        qemu_error("PCI: devfn %d not available for %s, in use by %s\n", devfn,
597
                 name, bus->devices[devfn]->name);
598
        return NULL;
599
    }
600
    pci_dev->bus = bus;
601
    pci_dev->devfn = devfn;
602
    pstrcpy(pci_dev->name, sizeof(pci_dev->name), name);
603
    pci_dev->irq_state = 0;
604
    pci_config_alloc(pci_dev);
605

    
606
    header_type &= ~PCI_HEADER_TYPE_MULTI_FUNCTION;
607
    if (header_type == PCI_HEADER_TYPE_NORMAL) {
608
        pci_set_default_subsystem_id(pci_dev);
609
    }
610
    pci_init_cmask(pci_dev);
611
    pci_init_wmask(pci_dev);
612
    if (header_type == PCI_HEADER_TYPE_BRIDGE) {
613
        pci_init_wmask_bridge(pci_dev);
614
    }
615

    
616
    if (!config_read)
617
        config_read = pci_default_read_config;
618
    if (!config_write)
619
        config_write = pci_default_write_config;
620
    pci_dev->config_read = config_read;
621
    pci_dev->config_write = config_write;
622
    bus->devices[devfn] = pci_dev;
623
    pci_dev->irq = qemu_allocate_irqs(pci_set_irq, pci_dev, PCI_NUM_PINS);
624
    pci_dev->version_id = 2; /* Current pci device vmstate version */
625
    return pci_dev;
626
}
627

    
628
PCIDevice *pci_register_device(PCIBus *bus, const char *name,
629
                               int instance_size, int devfn,
630
                               PCIConfigReadFunc *config_read,
631
                               PCIConfigWriteFunc *config_write)
632
{
633
    PCIDevice *pci_dev;
634

    
635
    pci_dev = qemu_mallocz(instance_size);
636
    pci_dev = do_pci_register_device(pci_dev, bus, name, devfn,
637
                                     config_read, config_write,
638
                                     PCI_HEADER_TYPE_NORMAL);
639
    if (pci_dev == NULL) {
640
        hw_error("PCI: can't register device\n");
641
    }
642
    return pci_dev;
643
}
644

    
645
static target_phys_addr_t pci_to_cpu_addr(PCIBus *bus,
646
                                          target_phys_addr_t addr)
647
{
648
    return addr + bus->mem_base;
649
}
650

    
651
static void pci_unregister_io_regions(PCIDevice *pci_dev)
652
{
653
    PCIIORegion *r;
654
    int i;
655

    
656
    for(i = 0; i < PCI_NUM_REGIONS; i++) {
657
        r = &pci_dev->io_regions[i];
658
        if (!r->size || r->addr == PCI_BAR_UNMAPPED)
659
            continue;
660
        if (r->type == PCI_BASE_ADDRESS_SPACE_IO) {
661
            isa_unassign_ioport(r->addr, r->filtered_size);
662
        } else {
663
            cpu_register_physical_memory(pci_to_cpu_addr(pci_dev->bus,
664
                                                         r->addr),
665
                                         r->filtered_size,
666
                                         IO_MEM_UNASSIGNED);
667
        }
668
    }
669
}
670

    
671
static int pci_unregister_device(DeviceState *dev)
672
{
673
    PCIDevice *pci_dev = DO_UPCAST(PCIDevice, qdev, dev);
674
    PCIDeviceInfo *info = DO_UPCAST(PCIDeviceInfo, qdev, dev->info);
675
    int ret = 0;
676

    
677
    if (info->exit)
678
        ret = info->exit(pci_dev);
679
    if (ret)
680
        return ret;
681

    
682
    pci_unregister_io_regions(pci_dev);
683

    
684
    qemu_free_irqs(pci_dev->irq);
685
    pci_dev->bus->devices[pci_dev->devfn] = NULL;
686
    pci_config_free(pci_dev);
687
    return 0;
688
}
689

    
690
void pci_register_bar(PCIDevice *pci_dev, int region_num,
691
                            pcibus_t size, int type,
692
                            PCIMapIORegionFunc *map_func)
693
{
694
    PCIIORegion *r;
695
    uint32_t addr;
696
    pcibus_t wmask;
697

    
698
    if ((unsigned int)region_num >= PCI_NUM_REGIONS)
699
        return;
700

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

    
707
    r = &pci_dev->io_regions[region_num];
708
    r->addr = PCI_BAR_UNMAPPED;
709
    r->size = size;
710
    r->filtered_size = size;
711
    r->type = type;
712
    r->map_func = map_func;
713

    
714
    wmask = ~(size - 1);
715
    addr = pci_bar(pci_dev, region_num);
716
    if (region_num == PCI_ROM_SLOT) {
717
        /* ROM enable bit is writeable */
718
        wmask |= PCI_ROM_ADDRESS_ENABLE;
719
    }
720
    pci_set_long(pci_dev->config + addr, type);
721
    if (!(r->type & PCI_BASE_ADDRESS_SPACE_IO) &&
722
        r->type & PCI_BASE_ADDRESS_MEM_TYPE_64) {
723
        pci_set_quad(pci_dev->wmask + addr, wmask);
724
        pci_set_quad(pci_dev->cmask + addr, ~0ULL);
725
    } else {
726
        pci_set_long(pci_dev->wmask + addr, wmask & 0xffffffff);
727
        pci_set_long(pci_dev->cmask + addr, 0xffffffff);
728
    }
729
}
730

    
731
static uint32_t pci_config_get_io_base(PCIDevice *d,
732
                                       uint32_t base, uint32_t base_upper16)
733
{
734
    uint32_t val;
735

    
736
    val = ((uint32_t)d->config[base] & PCI_IO_RANGE_MASK) << 8;
737
    if (d->config[base] & PCI_IO_RANGE_TYPE_32) {
738
        val |= (uint32_t)pci_get_word(d->config + base_upper16) << 16;
739
    }
740
    return val;
741
}
742

    
743
static pcibus_t pci_config_get_memory_base(PCIDevice *d, uint32_t base)
744
{
745
    return ((pcibus_t)pci_get_word(d->config + base) & PCI_MEMORY_RANGE_MASK)
746
        << 16;
747
}
748

    
749
static pcibus_t pci_config_get_pref_base(PCIDevice *d,
750
                                         uint32_t base, uint32_t upper)
751
{
752
    pcibus_t tmp;
753
    pcibus_t val;
754

    
755
    tmp = (pcibus_t)pci_get_word(d->config + base);
756
    val = (tmp & PCI_PREF_RANGE_MASK) << 16;
757
    if (tmp & PCI_PREF_RANGE_TYPE_64) {
758
        val |= (pcibus_t)pci_get_long(d->config + upper) << 32;
759
    }
760
    return val;
761
}
762

    
763
static pcibus_t pci_bridge_get_base(PCIDevice *bridge, uint8_t type)
764
{
765
    pcibus_t base;
766
    if (type & PCI_BASE_ADDRESS_SPACE_IO) {
767
        base = pci_config_get_io_base(bridge,
768
                                      PCI_IO_BASE, PCI_IO_BASE_UPPER16);
769
    } else {
770
        if (type & PCI_BASE_ADDRESS_MEM_PREFETCH) {
771
            base = pci_config_get_pref_base(
772
                bridge, PCI_PREF_MEMORY_BASE, PCI_PREF_BASE_UPPER32);
773
        } else {
774
            base = pci_config_get_memory_base(bridge, PCI_MEMORY_BASE);
775
        }
776
    }
777

    
778
    return base;
779
}
780

    
781
static pcibus_t pci_bridge_get_limit(PCIDevice *bridge, uint8_t type)
782
{
783
    pcibus_t limit;
784
    if (type & PCI_BASE_ADDRESS_SPACE_IO) {
785
        limit = pci_config_get_io_base(bridge,
786
                                      PCI_IO_LIMIT, PCI_IO_LIMIT_UPPER16);
787
        limit |= 0xfff;         /* PCI bridge spec 3.2.5.6. */
788
    } else {
789
        if (type & PCI_BASE_ADDRESS_MEM_PREFETCH) {
790
            limit = pci_config_get_pref_base(
791
                bridge, PCI_PREF_MEMORY_LIMIT, PCI_PREF_LIMIT_UPPER32);
792
        } else {
793
            limit = pci_config_get_memory_base(bridge, PCI_MEMORY_LIMIT);
794
        }
795
        limit |= 0xfffff;       /* PCI bridge spec 3.2.5.{1, 8}. */
796
    }
797
    return limit;
798
}
799

    
800
static void pci_bridge_filter(PCIDevice *d, pcibus_t *addr, pcibus_t *size,
801
                              uint8_t type)
802
{
803
    pcibus_t base = *addr;
804
    pcibus_t limit = *addr + *size - 1;
805
    PCIDevice *br;
806

    
807
    for (br = d->bus->parent_dev; br; br = br->bus->parent_dev) {
808
        uint16_t cmd = pci_get_word(d->config + PCI_COMMAND);
809

    
810
        if (type & PCI_BASE_ADDRESS_SPACE_IO) {
811
            if (!(cmd & PCI_COMMAND_IO)) {
812
                goto no_map;
813
            }
814
        } else {
815
            if (!(cmd & PCI_COMMAND_MEMORY)) {
816
                goto no_map;
817
            }
818
        }
819

    
820
        base = MAX(base, pci_bridge_get_base(br, type));
821
        limit = MIN(limit, pci_bridge_get_limit(br, type));
822
    }
823

    
824
    if (base > limit) {
825
        goto no_map;
826
    }
827
    *addr = base;
828
    *size = limit - base + 1;
829
    return;
830
no_map:
831
    *addr = PCI_BAR_UNMAPPED;
832
    *size = 0;
833
}
834

    
835
static pcibus_t pci_bar_address(PCIDevice *d,
836
                                int reg, uint8_t type, pcibus_t size)
837
{
838
    pcibus_t new_addr, last_addr;
839
    int bar = pci_bar(d, reg);
840
    uint16_t cmd = pci_get_word(d->config + PCI_COMMAND);
841

    
842
    if (type & PCI_BASE_ADDRESS_SPACE_IO) {
843
        if (!(cmd & PCI_COMMAND_IO)) {
844
            return PCI_BAR_UNMAPPED;
845
        }
846
        new_addr = pci_get_long(d->config + bar) & ~(size - 1);
847
        last_addr = new_addr + size - 1;
848
        /* NOTE: we have only 64K ioports on PC */
849
        if (last_addr <= new_addr || new_addr == 0 || last_addr > UINT16_MAX) {
850
            return PCI_BAR_UNMAPPED;
851
        }
852
        return new_addr;
853
    }
854

    
855
    if (!(cmd & PCI_COMMAND_MEMORY)) {
856
        return PCI_BAR_UNMAPPED;
857
    }
858
    if (type & PCI_BASE_ADDRESS_MEM_TYPE_64) {
859
        new_addr = pci_get_quad(d->config + bar);
860
    } else {
861
        new_addr = pci_get_long(d->config + bar);
862
    }
863
    /* the ROM slot has a specific enable bit */
864
    if (reg == PCI_ROM_SLOT && !(new_addr & PCI_ROM_ADDRESS_ENABLE)) {
865
        return PCI_BAR_UNMAPPED;
866
    }
867
    new_addr &= ~(size - 1);
868
    last_addr = new_addr + size - 1;
869
    /* NOTE: we do not support wrapping */
870
    /* XXX: as we cannot support really dynamic
871
       mappings, we handle specific values as invalid
872
       mappings. */
873
    if (last_addr <= new_addr || new_addr == 0 ||
874
        last_addr == PCI_BAR_UNMAPPED) {
875
        return PCI_BAR_UNMAPPED;
876
    }
877

    
878
    /* Now pcibus_t is 64bit.
879
     * Check if 32 bit BAR wraps around explicitly.
880
     * Without this, PC ide doesn't work well.
881
     * TODO: remove this work around.
882
     */
883
    if  (!(type & PCI_BASE_ADDRESS_MEM_TYPE_64) && last_addr >= UINT32_MAX) {
884
        return PCI_BAR_UNMAPPED;
885
    }
886

    
887
    /*
888
     * OS is allowed to set BAR beyond its addressable
889
     * bits. For example, 32 bit OS can set 64bit bar
890
     * to >4G. Check it. TODO: we might need to support
891
     * it in the future for e.g. PAE.
892
     */
893
    if (last_addr >= TARGET_PHYS_ADDR_MAX) {
894
        return PCI_BAR_UNMAPPED;
895
    }
896

    
897
    return new_addr;
898
}
899

    
900
static void pci_update_mappings(PCIDevice *d)
901
{
902
    PCIIORegion *r;
903
    int i;
904
    pcibus_t new_addr, filtered_size;
905

    
906
    for(i = 0; i < PCI_NUM_REGIONS; i++) {
907
        r = &d->io_regions[i];
908

    
909
        /* this region isn't registered */
910
        if (!r->size)
911
            continue;
912

    
913
        new_addr = pci_bar_address(d, i, r->type, r->size);
914

    
915
        /* bridge filtering */
916
        filtered_size = r->size;
917
        if (new_addr != PCI_BAR_UNMAPPED) {
918
            pci_bridge_filter(d, &new_addr, &filtered_size, r->type);
919
        }
920

    
921
        /* This bar isn't changed */
922
        if (new_addr == r->addr && filtered_size == r->filtered_size)
923
            continue;
924

    
925
        /* now do the real mapping */
926
        if (r->addr != PCI_BAR_UNMAPPED) {
927
            if (r->type & PCI_BASE_ADDRESS_SPACE_IO) {
928
                int class;
929
                /* NOTE: specific hack for IDE in PC case:
930
                   only one byte must be mapped. */
931
                class = pci_get_word(d->config + PCI_CLASS_DEVICE);
932
                if (class == 0x0101 && r->size == 4) {
933
                    isa_unassign_ioport(r->addr + 2, 1);
934
                } else {
935
                    isa_unassign_ioport(r->addr, r->filtered_size);
936
                }
937
            } else {
938
                cpu_register_physical_memory(pci_to_cpu_addr(d->bus, r->addr),
939
                                             r->filtered_size,
940
                                             IO_MEM_UNASSIGNED);
941
                qemu_unregister_coalesced_mmio(r->addr, r->filtered_size);
942
            }
943
        }
944
        r->addr = new_addr;
945
        r->filtered_size = filtered_size;
946
        if (r->addr != PCI_BAR_UNMAPPED) {
947
            /*
948
             * TODO: currently almost all the map funcions assumes
949
             * filtered_size == size and addr & ~(size - 1) == addr.
950
             * However with bridge filtering, they aren't always true.
951
             * Teach them such cases, such that filtered_size < size and
952
             * addr & (size - 1) != 0.
953
             */
954
            if (r->type & PCI_BASE_ADDRESS_SPACE_IO) {
955
                r->map_func(d, i, r->addr, r->filtered_size, r->type);
956
            } else {
957
                r->map_func(d, i, pci_to_cpu_addr(d->bus, r->addr),
958
                            r->filtered_size, r->type);
959
            }
960
        }
961
    }
962
}
963

    
964
static inline int pci_irq_disabled(PCIDevice *d)
965
{
966
    return pci_get_word(d->config + PCI_COMMAND) & PCI_COMMAND_INTX_DISABLE;
967
}
968

    
969
/* Called after interrupt disabled field update in config space,
970
 * assert/deassert interrupts if necessary.
971
 * Gets original interrupt disable bit value (before update). */
972
static void pci_update_irq_disabled(PCIDevice *d, int was_irq_disabled)
973
{
974
    int i, disabled = pci_irq_disabled(d);
975
    if (disabled == was_irq_disabled)
976
        return;
977
    for (i = 0; i < PCI_NUM_PINS; ++i) {
978
        int state = pci_irq_state(d, i);
979
        pci_change_irq_level(d, i, disabled ? -state : state);
980
    }
981
}
982

    
983
uint32_t pci_default_read_config(PCIDevice *d,
984
                                 uint32_t address, int len)
985
{
986
    uint32_t val = 0;
987
    assert(len == 1 || len == 2 || len == 4);
988
    len = MIN(len, pci_config_size(d) - address);
989
    memcpy(&val, d->config + address, len);
990
    return le32_to_cpu(val);
991
}
992

    
993
void pci_default_write_config(PCIDevice *d, uint32_t addr, uint32_t val, int l)
994
{
995
    int i, was_irq_disabled = pci_irq_disabled(d);
996
    uint32_t config_size = pci_config_size(d);
997

    
998
    for (i = 0; i < l && addr + i < config_size; val >>= 8, ++i) {
999
        uint8_t wmask = d->wmask[addr + i];
1000
        d->config[addr + i] = (d->config[addr + i] & ~wmask) | (val & wmask);
1001
    }
1002
    if (ranges_overlap(addr, l, PCI_BASE_ADDRESS_0, 24) ||
1003
        ranges_overlap(addr, l, PCI_ROM_ADDRESS, 4) ||
1004
        ranges_overlap(addr, l, PCI_ROM_ADDRESS1, 4) ||
1005
        range_covers_byte(addr, l, PCI_COMMAND))
1006
        pci_update_mappings(d);
1007

    
1008
    if (range_covers_byte(addr, l, PCI_COMMAND))
1009
        pci_update_irq_disabled(d, was_irq_disabled);
1010
}
1011

    
1012
/***********************************************************/
1013
/* generic PCI irq support */
1014

    
1015
/* 0 <= irq_num <= 3. level must be 0 or 1 */
1016
static void pci_set_irq(void *opaque, int irq_num, int level)
1017
{
1018
    PCIDevice *pci_dev = opaque;
1019
    int change;
1020

    
1021
    change = level - pci_irq_state(pci_dev, irq_num);
1022
    if (!change)
1023
        return;
1024

    
1025
    pci_set_irq_state(pci_dev, irq_num, level);
1026
    pci_update_irq_status(pci_dev);
1027
    if (pci_irq_disabled(pci_dev))
1028
        return;
1029
    pci_change_irq_level(pci_dev, irq_num, change);
1030
}
1031

    
1032
/***********************************************************/
1033
/* monitor info on PCI */
1034

    
1035
typedef struct {
1036
    uint16_t class;
1037
    const char *desc;
1038
} pci_class_desc;
1039

    
1040
static const pci_class_desc pci_class_descriptions[] =
1041
{
1042
    { 0x0100, "SCSI controller"},
1043
    { 0x0101, "IDE controller"},
1044
    { 0x0102, "Floppy controller"},
1045
    { 0x0103, "IPI controller"},
1046
    { 0x0104, "RAID controller"},
1047
    { 0x0106, "SATA controller"},
1048
    { 0x0107, "SAS controller"},
1049
    { 0x0180, "Storage controller"},
1050
    { 0x0200, "Ethernet controller"},
1051
    { 0x0201, "Token Ring controller"},
1052
    { 0x0202, "FDDI controller"},
1053
    { 0x0203, "ATM controller"},
1054
    { 0x0280, "Network controller"},
1055
    { 0x0300, "VGA controller"},
1056
    { 0x0301, "XGA controller"},
1057
    { 0x0302, "3D controller"},
1058
    { 0x0380, "Display controller"},
1059
    { 0x0400, "Video controller"},
1060
    { 0x0401, "Audio controller"},
1061
    { 0x0402, "Phone"},
1062
    { 0x0480, "Multimedia controller"},
1063
    { 0x0500, "RAM controller"},
1064
    { 0x0501, "Flash controller"},
1065
    { 0x0580, "Memory controller"},
1066
    { 0x0600, "Host bridge"},
1067
    { 0x0601, "ISA bridge"},
1068
    { 0x0602, "EISA bridge"},
1069
    { 0x0603, "MC bridge"},
1070
    { 0x0604, "PCI bridge"},
1071
    { 0x0605, "PCMCIA bridge"},
1072
    { 0x0606, "NUBUS bridge"},
1073
    { 0x0607, "CARDBUS bridge"},
1074
    { 0x0608, "RACEWAY bridge"},
1075
    { 0x0680, "Bridge"},
1076
    { 0x0c03, "USB controller"},
1077
    { 0, NULL}
1078
};
1079

    
1080
static void pci_for_each_device_under_bus(PCIBus *bus,
1081
                                          void (*fn)(PCIBus *b, PCIDevice *d))
1082
{
1083
    PCIDevice *d;
1084
    int devfn;
1085

    
1086
    for(devfn = 0; devfn < ARRAY_SIZE(bus->devices); devfn++) {
1087
        d = bus->devices[devfn];
1088
        if (d) {
1089
            fn(bus, d);
1090
        }
1091
    }
1092
}
1093

    
1094
void pci_for_each_device(PCIBus *bus, int bus_num,
1095
                         void (*fn)(PCIBus *b, PCIDevice *d))
1096
{
1097
    bus = pci_find_bus(bus, bus_num);
1098

    
1099
    if (bus) {
1100
        pci_for_each_device_under_bus(bus, fn);
1101
    }
1102
}
1103

    
1104
static void pci_device_print(Monitor *mon, QDict *device)
1105
{
1106
    QDict *qdict;
1107
    QListEntry *entry;
1108
    uint64_t addr, size;
1109

    
1110
    monitor_printf(mon, "  Bus %2" PRId64 ", ", qdict_get_int(device, "bus"));
1111
    monitor_printf(mon, "device %3" PRId64 ", function %" PRId64 ":\n",
1112
                        qdict_get_int(device, "slot"),
1113
                        qdict_get_int(device, "function"));
1114
    monitor_printf(mon, "    ");
1115

    
1116
    qdict = qdict_get_qdict(device, "class_info");
1117
    if (qdict_haskey(qdict, "desc")) {
1118
        monitor_printf(mon, "%s", qdict_get_str(qdict, "desc"));
1119
    } else {
1120
        monitor_printf(mon, "Class %04" PRId64, qdict_get_int(qdict, "class"));
1121
    }
1122

    
1123
    qdict = qdict_get_qdict(device, "id");
1124
    monitor_printf(mon, ": PCI device %04" PRIx64 ":%04" PRIx64 "\n",
1125
                        qdict_get_int(qdict, "device"),
1126
                        qdict_get_int(qdict, "vendor"));
1127

    
1128
    if (qdict_haskey(device, "irq")) {
1129
        monitor_printf(mon, "      IRQ %" PRId64 ".\n",
1130
                            qdict_get_int(device, "irq"));
1131
    }
1132

    
1133
    if (qdict_haskey(device, "pci_bridge")) {
1134
        QDict *info;
1135

    
1136
        qdict = qdict_get_qdict(device, "pci_bridge");
1137

    
1138
        info = qdict_get_qdict(qdict, "bus");
1139
        monitor_printf(mon, "      BUS %" PRId64 ".\n",
1140
                            qdict_get_int(info, "number"));
1141
        monitor_printf(mon, "      secondary bus %" PRId64 ".\n",
1142
                            qdict_get_int(info, "secondary"));
1143
        monitor_printf(mon, "      subordinate bus %" PRId64 ".\n",
1144
                            qdict_get_int(info, "subordinate"));
1145

    
1146
        info = qdict_get_qdict(qdict, "io_range");
1147
        monitor_printf(mon, "      IO range [0x%04"PRIx64", 0x%04"PRIx64"]\n",
1148
                       qdict_get_int(info, "base"),
1149
                       qdict_get_int(info, "limit"));
1150

    
1151
        info = qdict_get_qdict(qdict, "memory_range");
1152
        monitor_printf(mon,
1153
                       "      memory range [0x%08"PRIx64", 0x%08"PRIx64"]\n",
1154
                       qdict_get_int(info, "base"),
1155
                       qdict_get_int(info, "limit"));
1156

    
1157
        info = qdict_get_qdict(qdict, "prefetchable_range");
1158
        monitor_printf(mon, "      prefetchable memory range "
1159
                       "[0x%08"PRIx64", 0x%08"PRIx64"]\n",
1160
                       qdict_get_int(info, "base"),
1161
        qdict_get_int(info, "limit"));
1162
    }
1163

    
1164
    QLIST_FOREACH_ENTRY(qdict_get_qlist(device, "regions"), entry) {
1165
        qdict = qobject_to_qdict(qlist_entry_obj(entry));
1166
        monitor_printf(mon, "      BAR%d: ", (int) qdict_get_int(qdict, "bar"));
1167

    
1168
        addr = qdict_get_int(qdict, "address");
1169
        size = qdict_get_int(qdict, "size");
1170

    
1171
        if (!strcmp(qdict_get_str(qdict, "type"), "io")) {
1172
            monitor_printf(mon, "I/O at 0x%04"FMT_PCIBUS
1173
                                " [0x%04"FMT_PCIBUS"].\n",
1174
                                addr, addr + size - 1);
1175
        } else {
1176
            monitor_printf(mon, "%d bit%s memory at 0x%08"FMT_PCIBUS
1177
                               " [0x%08"FMT_PCIBUS"].\n",
1178
                                qdict_get_bool(qdict, "mem_type_64") ? 64 : 32,
1179
                                qdict_get_bool(qdict, "prefetch") ?
1180
                                " prefetchable" : "", addr, addr + size - 1);
1181
        }
1182
    }
1183

    
1184
    monitor_printf(mon, "      id \"%s\"\n", qdict_get_str(device, "qdev_id"));
1185

    
1186
    if (qdict_haskey(device, "pci_bridge")) {
1187
        qdict = qdict_get_qdict(device, "pci_bridge");
1188
        if (qdict_haskey(qdict, "devices")) {
1189
            QListEntry *dev;
1190
            QLIST_FOREACH_ENTRY(qdict_get_qlist(qdict, "devices"), dev) {
1191
                pci_device_print(mon, qobject_to_qdict(qlist_entry_obj(dev)));
1192
            }
1193
        }
1194
    }
1195
}
1196

    
1197
void do_pci_info_print(Monitor *mon, const QObject *data)
1198
{
1199
    QListEntry *bus, *dev;
1200

    
1201
    QLIST_FOREACH_ENTRY(qobject_to_qlist(data), bus) {
1202
        QDict *qdict = qobject_to_qdict(qlist_entry_obj(bus));
1203
        QLIST_FOREACH_ENTRY(qdict_get_qlist(qdict, "devices"), dev) {
1204
            pci_device_print(mon, qobject_to_qdict(qlist_entry_obj(dev)));
1205
        }
1206
    }
1207
}
1208

    
1209
static QObject *pci_get_dev_class(const PCIDevice *dev)
1210
{
1211
    int class;
1212
    const pci_class_desc *desc;
1213

    
1214
    class = pci_get_word(dev->config + PCI_CLASS_DEVICE);
1215
    desc = pci_class_descriptions;
1216
    while (desc->desc && class != desc->class)
1217
        desc++;
1218

    
1219
    if (desc->desc) {
1220
        return qobject_from_jsonf("{ 'desc': %s, 'class': %d }",
1221
                                  desc->desc, class);
1222
    } else {
1223
        return qobject_from_jsonf("{ 'class': %d }", class);
1224
    }
1225
}
1226

    
1227
static QObject *pci_get_dev_id(const PCIDevice *dev)
1228
{
1229
    return qobject_from_jsonf("{ 'device': %d, 'vendor': %d }",
1230
                              pci_get_word(dev->config + PCI_VENDOR_ID),
1231
                              pci_get_word(dev->config + PCI_DEVICE_ID));
1232
}
1233

    
1234
static QObject *pci_get_regions_list(const PCIDevice *dev)
1235
{
1236
    int i;
1237
    QList *regions_list;
1238

    
1239
    regions_list = qlist_new();
1240

    
1241
    for (i = 0; i < PCI_NUM_REGIONS; i++) {
1242
        QObject *obj;
1243
        const PCIIORegion *r = &dev->io_regions[i];
1244

    
1245
        if (!r->size) {
1246
            continue;
1247
        }
1248

    
1249
        if (r->type & PCI_BASE_ADDRESS_SPACE_IO) {
1250
            obj = qobject_from_jsonf("{ 'bar': %d, 'type': 'io', "
1251
                                     "'address': %" PRId64 ", "
1252
                                     "'size': %" PRId64 " }",
1253
                                     i, r->addr, r->size);
1254
        } else {
1255
            int mem_type_64 = r->type & PCI_BASE_ADDRESS_MEM_TYPE_64;
1256

    
1257
            obj = qobject_from_jsonf("{ 'bar': %d, 'type': 'memory', "
1258
                                     "'mem_type_64': %i, 'prefetch': %i, "
1259
                                     "'address': %" PRId64 ", "
1260
                                     "'size': %" PRId64 " }",
1261
                                     i, mem_type_64,
1262
                                     r->type & PCI_BASE_ADDRESS_MEM_PREFETCH,
1263
                                     r->addr, r->size);
1264
        }
1265

    
1266
        qlist_append_obj(regions_list, obj);
1267
    }
1268

    
1269
    return QOBJECT(regions_list);
1270
}
1271

    
1272
static QObject *pci_get_devices_list(PCIBus *bus, int bus_num);
1273

    
1274
static QObject *pci_get_dev_dict(PCIDevice *dev, PCIBus *bus, int bus_num)
1275
{
1276
    int class;
1277
    QObject *obj;
1278

    
1279
    obj = qobject_from_jsonf("{ 'bus': %d, 'slot': %d, 'function': %d,"                                       "'class_info': %p, 'id': %p, 'regions': %p,"
1280
                              " 'qdev_id': %s }",
1281
                              bus_num,
1282
                              PCI_SLOT(dev->devfn), PCI_FUNC(dev->devfn),
1283
                              pci_get_dev_class(dev), pci_get_dev_id(dev),
1284
                              pci_get_regions_list(dev),
1285
                              dev->qdev.id ? dev->qdev.id : "");
1286

    
1287
    if (dev->config[PCI_INTERRUPT_PIN] != 0) {
1288
        QDict *qdict = qobject_to_qdict(obj);
1289
        qdict_put(qdict, "irq", qint_from_int(dev->config[PCI_INTERRUPT_LINE]));
1290
    }
1291

    
1292
    class = pci_get_word(dev->config + PCI_CLASS_DEVICE);
1293
    if (class == 0x0604) {
1294
        QDict *qdict;
1295
        QObject *pci_bridge;
1296

    
1297
        pci_bridge = qobject_from_jsonf("{ 'bus': "
1298
        "{ 'number': %d, 'secondary': %d, 'subordinate': %d }, "
1299
        "'io_range': { 'base': %" PRId64 ", 'limit': %" PRId64 "}, "
1300
        "'memory_range': { 'base': %" PRId64 ", 'limit': %" PRId64 "}, "
1301
        "'prefetchable_range': { 'base': %" PRId64 ", 'limit': %" PRId64 "} }",
1302
        dev->config[0x19], dev->config[PCI_SECONDARY_BUS],
1303
        dev->config[PCI_SUBORDINATE_BUS],
1304
        pci_bridge_get_base(dev, PCI_BASE_ADDRESS_SPACE_IO),
1305
        pci_bridge_get_limit(dev, PCI_BASE_ADDRESS_SPACE_IO),
1306
        pci_bridge_get_base(dev, PCI_BASE_ADDRESS_SPACE_MEMORY),
1307
        pci_bridge_get_limit(dev, PCI_BASE_ADDRESS_SPACE_MEMORY),
1308
        pci_bridge_get_base(dev, PCI_BASE_ADDRESS_SPACE_MEMORY |
1309
                               PCI_BASE_ADDRESS_MEM_PREFETCH),
1310
        pci_bridge_get_limit(dev, PCI_BASE_ADDRESS_SPACE_MEMORY |
1311
                                PCI_BASE_ADDRESS_MEM_PREFETCH));
1312

    
1313
        if (dev->config[0x19] != 0) {
1314
            qdict = qobject_to_qdict(pci_bridge);
1315
            qdict_put_obj(qdict, "devices",
1316
                          pci_get_devices_list(bus, dev->config[0x19]));
1317
        }
1318

    
1319
        qdict = qobject_to_qdict(obj);
1320
        qdict_put_obj(qdict, "pci_bridge", pci_bridge);
1321
    }
1322

    
1323
    return obj;
1324
}
1325

    
1326
static QObject *pci_get_devices_list(PCIBus *bus, int bus_num)
1327
{
1328
    int devfn;
1329
    PCIDevice *dev;
1330
    QList *dev_list;
1331

    
1332
    dev_list = qlist_new();
1333

    
1334
    for (devfn = 0; devfn < ARRAY_SIZE(bus->devices); devfn++) {
1335
        dev = bus->devices[devfn];
1336
        if (dev) {
1337
            qlist_append_obj(dev_list, pci_get_dev_dict(dev, bus, bus_num));
1338
        }
1339
    }
1340

    
1341
    return QOBJECT(dev_list);
1342
}
1343

    
1344
static QObject *pci_get_bus_dict(PCIBus *bus, int bus_num)
1345
{
1346
    bus = pci_find_bus(bus, bus_num);
1347
    if (bus) {
1348
        return qobject_from_jsonf("{ 'bus': %d, 'devices': %p }",
1349
                                  bus_num, pci_get_devices_list(bus, bus_num));
1350
    }
1351

    
1352
    return NULL;
1353
}
1354

    
1355
/**
1356
 * do_pci_info(): PCI buses and devices information
1357
 *
1358
 * The returned QObject is a QList of all buses. Each bus is
1359
 * represented by a QDict, which has a key with a QList of all
1360
 * PCI devices attached to it. Each device is represented by
1361
 * a QDict.
1362
 *
1363
 * The bus QDict contains the following:
1364
 *
1365
 * - "bus": bus number
1366
 * - "devices": a QList of QDicts, each QDict represents a PCI
1367
 *   device
1368
 *
1369
 * The PCI device QDict contains the following:
1370
 *
1371
 * - "bus": identical to the parent's bus number
1372
 * - "slot": slot number
1373
 * - "function": function number
1374
 * - "class_info": a QDict containing:
1375
 *      - "desc": device class description (optional)
1376
 *      - "class": device class number
1377
 * - "id": a QDict containing:
1378
 *      - "device": device ID
1379
 *      - "vendor": vendor ID
1380
 * - "irq": device's IRQ if assigned (optional)
1381
 * - "qdev_id": qdev id string
1382
 * - "pci_bridge": It's a QDict, only present if this device is a
1383
 *   PCI bridge, contains:
1384
 *      - "bus": bus number
1385
 *      - "secondary": secondary bus number
1386
 *      - "subordinate": subordinate bus number
1387
 *      - "io_range": a QDict with memory range information
1388
 *      - "memory_range": a QDict with memory range information
1389
 *      - "prefetchable_range": a QDict with memory range information
1390
 *      - "devices": a QList of PCI devices if there's any attached (optional)
1391
 * - "regions": a QList of QDicts, each QDict represents a
1392
 *   memory region of this device
1393
 *
1394
 * The memory range QDict contains the following:
1395
 *
1396
 * - "base": base memory address
1397
 * - "limit": limit value
1398
 *
1399
 * The region QDict can be an I/O region or a memory region,
1400
 * an I/O region QDict contains the following:
1401
 *
1402
 * - "type": "io"
1403
 * - "bar": BAR number
1404
 * - "address": memory address
1405
 * - "size": memory size
1406
 *
1407
 * A memory region QDict contains the following:
1408
 *
1409
 * - "type": "memory"
1410
 * - "bar": BAR number
1411
 * - "address": memory address
1412
 * - "size": memory size
1413
 * - "mem_type_64": true or false
1414
 * - "prefetch": true or false
1415
 */
1416
void do_pci_info(Monitor *mon, QObject **ret_data)
1417
{
1418
    QList *bus_list;
1419
    struct PCIHostBus *host;
1420

    
1421
    bus_list = qlist_new();
1422

    
1423
    QLIST_FOREACH(host, &host_buses, next) {
1424
        QObject *obj = pci_get_bus_dict(host->bus, 0);
1425
        if (obj) {
1426
            qlist_append_obj(bus_list, obj);
1427
        }
1428
    }
1429

    
1430
    *ret_data = QOBJECT(bus_list);
1431
}
1432

    
1433
static const char * const pci_nic_models[] = {
1434
    "ne2k_pci",
1435
    "i82551",
1436
    "i82557b",
1437
    "i82559er",
1438
    "rtl8139",
1439
    "e1000",
1440
    "pcnet",
1441
    "virtio",
1442
    NULL
1443
};
1444

    
1445
static const char * const pci_nic_names[] = {
1446
    "ne2k_pci",
1447
    "i82551",
1448
    "i82557b",
1449
    "i82559er",
1450
    "rtl8139",
1451
    "e1000",
1452
    "pcnet",
1453
    "virtio-net-pci",
1454
    NULL
1455
};
1456

    
1457
/* Initialize a PCI NIC.  */
1458
/* FIXME callers should check for failure, but don't */
1459
PCIDevice *pci_nic_init(NICInfo *nd, const char *default_model,
1460
                        const char *default_devaddr)
1461
{
1462
    const char *devaddr = nd->devaddr ? nd->devaddr : default_devaddr;
1463
    PCIBus *bus;
1464
    int devfn;
1465
    PCIDevice *pci_dev;
1466
    DeviceState *dev;
1467
    int i;
1468

    
1469
    i = qemu_find_nic_model(nd, pci_nic_models, default_model);
1470
    if (i < 0)
1471
        return NULL;
1472

    
1473
    bus = pci_get_bus_devfn(&devfn, devaddr);
1474
    if (!bus) {
1475
        qemu_error("Invalid PCI device address %s for device %s\n",
1476
                   devaddr, pci_nic_names[i]);
1477
        return NULL;
1478
    }
1479

    
1480
    pci_dev = pci_create(bus, devfn, pci_nic_names[i]);
1481
    dev = &pci_dev->qdev;
1482
    if (nd->name)
1483
        dev->id = qemu_strdup(nd->name);
1484
    qdev_set_nic_properties(dev, nd);
1485
    if (qdev_init(dev) < 0)
1486
        return NULL;
1487
    return pci_dev;
1488
}
1489

    
1490
PCIDevice *pci_nic_init_nofail(NICInfo *nd, const char *default_model,
1491
                               const char *default_devaddr)
1492
{
1493
    PCIDevice *res;
1494

    
1495
    if (qemu_show_nic_models(nd->model, pci_nic_models))
1496
        exit(0);
1497

    
1498
    res = pci_nic_init(nd, default_model, default_devaddr);
1499
    if (!res)
1500
        exit(1);
1501
    return res;
1502
}
1503

    
1504
typedef struct {
1505
    PCIDevice dev;
1506
    PCIBus bus;
1507
    uint32_t vid;
1508
    uint32_t did;
1509
} PCIBridge;
1510

    
1511

    
1512
static void pci_bridge_update_mappings_fn(PCIBus *b, PCIDevice *d)
1513
{
1514
    pci_update_mappings(d);
1515
}
1516

    
1517
static void pci_bridge_update_mappings(PCIBus *b)
1518
{
1519
    PCIBus *child;
1520

    
1521
    pci_for_each_device_under_bus(b, pci_bridge_update_mappings_fn);
1522

    
1523
    QLIST_FOREACH(child, &b->child, sibling) {
1524
        pci_bridge_update_mappings(child);
1525
    }
1526
}
1527

    
1528
static void pci_bridge_write_config(PCIDevice *d,
1529
                             uint32_t address, uint32_t val, int len)
1530
{
1531
    pci_default_write_config(d, address, val, len);
1532

    
1533
    if (/* io base/limit */
1534
        ranges_overlap(address, len, PCI_IO_BASE, 2) ||
1535

    
1536
        /* memory base/limit, prefetchable base/limit and
1537
           io base/limit upper 16 */
1538
        ranges_overlap(address, len, PCI_MEMORY_BASE, 20)) {
1539
        pci_bridge_update_mappings(d->bus);
1540
    }
1541
}
1542

    
1543
PCIBus *pci_find_bus(PCIBus *bus, int bus_num)
1544
{
1545
    PCIBus *sec;
1546

    
1547
    if (!bus)
1548
        return NULL;
1549

    
1550
    if (pci_bus_num(bus) == bus_num) {
1551
        return bus;
1552
    }
1553

    
1554
    /* try child bus */
1555
    QLIST_FOREACH(sec, &bus->child, sibling) {
1556

    
1557
        if (!bus->parent_dev /* pci host bridge */
1558
            || (pci_bus_num(sec) <= bus_num &&
1559
                bus->parent_dev->config[PCI_SUBORDINATE_BUS])) {
1560
            return pci_find_bus(sec, bus_num);
1561
        }
1562
    }
1563

    
1564
    return NULL;
1565
}
1566

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

    
1571
    if (!bus)
1572
        return NULL;
1573

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

    
1577
static int pci_bridge_initfn(PCIDevice *dev)
1578
{
1579
    PCIBridge *s = DO_UPCAST(PCIBridge, dev, dev);
1580

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

    
1584
    pci_set_word(dev->config + PCI_STATUS,
1585
                 PCI_STATUS_66MHZ | PCI_STATUS_FAST_BACK);
1586
    pci_config_set_class(dev->config, PCI_CLASS_BRIDGE_PCI);
1587
    dev->config[PCI_HEADER_TYPE] = PCI_HEADER_TYPE_BRIDGE;
1588
    pci_set_word(dev->config + PCI_SEC_STATUS,
1589
                 PCI_STATUS_66MHZ | PCI_STATUS_FAST_BACK);
1590
    return 0;
1591
}
1592

    
1593
static int pci_bridge_exitfn(PCIDevice *pci_dev)
1594
{
1595
    PCIBridge *s = DO_UPCAST(PCIBridge, dev, pci_dev);
1596
    PCIBus *bus = &s->bus;
1597
    pci_unregister_secondary_bus(bus);
1598
    return 0;
1599
}
1600

    
1601
PCIBus *pci_bridge_init(PCIBus *bus, int devfn, uint16_t vid, uint16_t did,
1602
                        pci_map_irq_fn map_irq, const char *name)
1603
{
1604
    PCIDevice *dev;
1605
    PCIBridge *s;
1606

    
1607
    dev = pci_create(bus, devfn, "pci-bridge");
1608
    qdev_prop_set_uint32(&dev->qdev, "vendorid", vid);
1609
    qdev_prop_set_uint32(&dev->qdev, "deviceid", did);
1610
    qdev_init_nofail(&dev->qdev);
1611

    
1612
    s = DO_UPCAST(PCIBridge, dev, dev);
1613
    pci_register_secondary_bus(bus, &s->bus, &s->dev, map_irq, name);
1614
    return &s->bus;
1615
}
1616

    
1617
PCIDevice *pci_bridge_get_device(PCIBus *bus)
1618
{
1619
    return bus->parent_dev;
1620
}
1621

    
1622
static int pci_qdev_init(DeviceState *qdev, DeviceInfo *base)
1623
{
1624
    PCIDevice *pci_dev = (PCIDevice *)qdev;
1625
    PCIDeviceInfo *info = container_of(base, PCIDeviceInfo, qdev);
1626
    PCIBus *bus;
1627
    int devfn, rc;
1628

    
1629
    /* initialize cap_present for pci_is_express() and pci_config_size() */
1630
    if (info->is_express) {
1631
        pci_dev->cap_present |= QEMU_PCI_CAP_EXPRESS;
1632
    }
1633

    
1634
    bus = FROM_QBUS(PCIBus, qdev_get_parent_bus(qdev));
1635
    devfn = pci_dev->devfn;
1636
    pci_dev = do_pci_register_device(pci_dev, bus, base->name, devfn,
1637
                                     info->config_read, info->config_write,
1638
                                     info->header_type);
1639
    if (pci_dev == NULL)
1640
        return -1;
1641
    rc = info->init(pci_dev);
1642
    if (rc != 0)
1643
        return rc;
1644

    
1645
    /* rom loading */
1646
    if (pci_dev->romfile == NULL && info->romfile != NULL)
1647
        pci_dev->romfile = qemu_strdup(info->romfile);
1648
    pci_add_option_rom(pci_dev);
1649

    
1650
    if (qdev->hotplugged)
1651
        bus->hotplug(pci_dev, 1);
1652
    return 0;
1653
}
1654

    
1655
static int pci_unplug_device(DeviceState *qdev)
1656
{
1657
    PCIDevice *dev = DO_UPCAST(PCIDevice, qdev, qdev);
1658

    
1659
    dev->bus->hotplug(dev, 0);
1660
    return 0;
1661
}
1662

    
1663
void pci_qdev_register(PCIDeviceInfo *info)
1664
{
1665
    info->qdev.init = pci_qdev_init;
1666
    info->qdev.unplug = pci_unplug_device;
1667
    info->qdev.exit = pci_unregister_device;
1668
    info->qdev.bus_info = &pci_bus_info;
1669
    qdev_register(&info->qdev);
1670
}
1671

    
1672
void pci_qdev_register_many(PCIDeviceInfo *info)
1673
{
1674
    while (info->qdev.name) {
1675
        pci_qdev_register(info);
1676
        info++;
1677
    }
1678
}
1679

    
1680
PCIDevice *pci_create(PCIBus *bus, int devfn, const char *name)
1681
{
1682
    DeviceState *dev;
1683

    
1684
    dev = qdev_create(&bus->qbus, name);
1685
    qdev_prop_set_uint32(dev, "addr", devfn);
1686
    return DO_UPCAST(PCIDevice, qdev, dev);
1687
}
1688

    
1689
PCIDevice *pci_create_simple(PCIBus *bus, int devfn, const char *name)
1690
{
1691
    PCIDevice *dev = pci_create(bus, devfn, name);
1692
    qdev_init_nofail(&dev->qdev);
1693
    return dev;
1694
}
1695

    
1696
static int pci_find_space(PCIDevice *pdev, uint8_t size)
1697
{
1698
    int config_size = pci_config_size(pdev);
1699
    int offset = PCI_CONFIG_HEADER_SIZE;
1700
    int i;
1701
    for (i = PCI_CONFIG_HEADER_SIZE; i < config_size; ++i)
1702
        if (pdev->used[i])
1703
            offset = i + 1;
1704
        else if (i - offset + 1 == size)
1705
            return offset;
1706
    return 0;
1707
}
1708

    
1709
static uint8_t pci_find_capability_list(PCIDevice *pdev, uint8_t cap_id,
1710
                                        uint8_t *prev_p)
1711
{
1712
    uint8_t next, prev;
1713

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

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

    
1722
    if (prev_p)
1723
        *prev_p = prev;
1724
    return next;
1725
}
1726

    
1727
static void pci_map_option_rom(PCIDevice *pdev, int region_num, pcibus_t addr, pcibus_t size, int type)
1728
{
1729
    cpu_register_physical_memory(addr, size, pdev->rom_offset);
1730
}
1731

    
1732
/* Add an option rom for the device */
1733
static int pci_add_option_rom(PCIDevice *pdev)
1734
{
1735
    int size;
1736
    char *path;
1737
    void *ptr;
1738

    
1739
    if (!pdev->romfile)
1740
        return 0;
1741
    if (strlen(pdev->romfile) == 0)
1742
        return 0;
1743

    
1744
    if (!pdev->rom_bar) {
1745
        /*
1746
         * Load rom via fw_cfg instead of creating a rom bar,
1747
         * for 0.11 compatibility.
1748
         */
1749
        int class = pci_get_word(pdev->config + PCI_CLASS_DEVICE);
1750
        if (class == 0x0300) {
1751
            rom_add_vga(pdev->romfile);
1752
        } else {
1753
            rom_add_option(pdev->romfile);
1754
        }
1755
        return 0;
1756
    }
1757

    
1758
    path = qemu_find_file(QEMU_FILE_TYPE_BIOS, pdev->romfile);
1759
    if (path == NULL) {
1760
        path = qemu_strdup(pdev->romfile);
1761
    }
1762

    
1763
    size = get_image_size(path);
1764
    if (size < 0) {
1765
        qemu_error("%s: failed to find romfile \"%s\"\n", __FUNCTION__,
1766
                   pdev->romfile);
1767
        return -1;
1768
    }
1769
    if (size & (size - 1)) {
1770
        size = 1 << qemu_fls(size);
1771
    }
1772

    
1773
    pdev->rom_offset = qemu_ram_alloc(size);
1774

    
1775
    ptr = qemu_get_ram_ptr(pdev->rom_offset);
1776
    load_image(path, ptr);
1777
    qemu_free(path);
1778

    
1779
    pci_register_bar(pdev, PCI_ROM_SLOT, size,
1780
                     0, pci_map_option_rom);
1781

    
1782
    return 0;
1783
}
1784

    
1785
/* Reserve space and add capability to the linked list in pci config space */
1786
int pci_add_capability(PCIDevice *pdev, uint8_t cap_id, uint8_t size)
1787
{
1788
    uint8_t offset = pci_find_space(pdev, size);
1789
    uint8_t *config = pdev->config + offset;
1790
    if (!offset)
1791
        return -ENOSPC;
1792
    config[PCI_CAP_LIST_ID] = cap_id;
1793
    config[PCI_CAP_LIST_NEXT] = pdev->config[PCI_CAPABILITY_LIST];
1794
    pdev->config[PCI_CAPABILITY_LIST] = offset;
1795
    pdev->config[PCI_STATUS] |= PCI_STATUS_CAP_LIST;
1796
    memset(pdev->used + offset, 0xFF, size);
1797
    /* Make capability read-only by default */
1798
    memset(pdev->wmask + offset, 0, size);
1799
    /* Check capability by default */
1800
    memset(pdev->cmask + offset, 0xFF, size);
1801
    return offset;
1802
}
1803

    
1804
/* Unlink capability from the pci config space. */
1805
void pci_del_capability(PCIDevice *pdev, uint8_t cap_id, uint8_t size)
1806
{
1807
    uint8_t prev, offset = pci_find_capability_list(pdev, cap_id, &prev);
1808
    if (!offset)
1809
        return;
1810
    pdev->config[prev] = pdev->config[offset + PCI_CAP_LIST_NEXT];
1811
    /* Make capability writeable again */
1812
    memset(pdev->wmask + offset, 0xff, size);
1813
    /* Clear cmask as device-specific registers can't be checked */
1814
    memset(pdev->cmask + offset, 0, size);
1815
    memset(pdev->used + offset, 0, size);
1816

    
1817
    if (!pdev->config[PCI_CAPABILITY_LIST])
1818
        pdev->config[PCI_STATUS] &= ~PCI_STATUS_CAP_LIST;
1819
}
1820

    
1821
/* Reserve space for capability at a known offset (to call after load). */
1822
void pci_reserve_capability(PCIDevice *pdev, uint8_t offset, uint8_t size)
1823
{
1824
    memset(pdev->used + offset, 0xff, size);
1825
}
1826

    
1827
uint8_t pci_find_capability(PCIDevice *pdev, uint8_t cap_id)
1828
{
1829
    return pci_find_capability_list(pdev, cap_id, NULL);
1830
}
1831

    
1832
static void pcibus_dev_print(Monitor *mon, DeviceState *dev, int indent)
1833
{
1834
    PCIDevice *d = (PCIDevice *)dev;
1835
    const pci_class_desc *desc;
1836
    char ctxt[64];
1837
    PCIIORegion *r;
1838
    int i, class;
1839

    
1840
    class = pci_get_word(d->config + PCI_CLASS_DEVICE);
1841
    desc = pci_class_descriptions;
1842
    while (desc->desc && class != desc->class)
1843
        desc++;
1844
    if (desc->desc) {
1845
        snprintf(ctxt, sizeof(ctxt), "%s", desc->desc);
1846
    } else {
1847
        snprintf(ctxt, sizeof(ctxt), "Class %04x", class);
1848
    }
1849

    
1850
    monitor_printf(mon, "%*sclass %s, addr %02x:%02x.%x, "
1851
                   "pci id %04x:%04x (sub %04x:%04x)\n",
1852
                   indent, "", ctxt,
1853
                   d->config[PCI_SECONDARY_BUS],
1854
                   PCI_SLOT(d->devfn), PCI_FUNC(d->devfn),
1855
                   pci_get_word(d->config + PCI_VENDOR_ID),
1856
                   pci_get_word(d->config + PCI_DEVICE_ID),
1857
                   pci_get_word(d->config + PCI_SUBSYSTEM_VENDOR_ID),
1858
                   pci_get_word(d->config + PCI_SUBSYSTEM_ID));
1859
    for (i = 0; i < PCI_NUM_REGIONS; i++) {
1860
        r = &d->io_regions[i];
1861
        if (!r->size)
1862
            continue;
1863
        monitor_printf(mon, "%*sbar %d: %s at 0x%"FMT_PCIBUS
1864
                       " [0x%"FMT_PCIBUS"]\n",
1865
                       indent, "",
1866
                       i, r->type & PCI_BASE_ADDRESS_SPACE_IO ? "i/o" : "mem",
1867
                       r->addr, r->addr + r->size - 1);
1868
    }
1869
}
1870

    
1871
static PCIDeviceInfo bridge_info = {
1872
    .qdev.name    = "pci-bridge",
1873
    .qdev.size    = sizeof(PCIBridge),
1874
    .init         = pci_bridge_initfn,
1875
    .exit         = pci_bridge_exitfn,
1876
    .config_write = pci_bridge_write_config,
1877
    .header_type  = PCI_HEADER_TYPE_BRIDGE,
1878
    .qdev.props   = (Property[]) {
1879
        DEFINE_PROP_HEX32("vendorid", PCIBridge, vid, 0),
1880
        DEFINE_PROP_HEX32("deviceid", PCIBridge, did, 0),
1881
        DEFINE_PROP_END_OF_LIST(),
1882
    }
1883
};
1884

    
1885
static void pci_register_devices(void)
1886
{
1887
    pci_qdev_register(&bridge_info);
1888
}
1889

    
1890
device_init(pci_register_devices)