4 * Copyright (c) 2004 Fabrice Bellard
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:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
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
36 pci_set_irq_fn set_irq
;
37 pci_map_irq_fn map_irq
;
38 uint32_t config_reg
; /* XXX: suppress */
40 SetIRQFunc
*low_set_irq
;
42 PCIDevice
*devices
[256];
43 PCIDevice
*parent_dev
;
45 /* The bus IRQ state is the logical OR of the connected devices.
46 Keep a count of the number of devices with raised IRQs. */
51 static void pci_update_mappings(PCIDevice
*d
);
52 static void pci_set_irq(void *opaque
, int irq_num
, int level
);
54 target_phys_addr_t pci_mem_base
;
55 static uint16_t pci_default_sub_vendor_id
= PCI_SUBVENDOR_ID_REDHAT_QUMRANET
;
56 static uint16_t pci_default_sub_device_id
= PCI_SUBDEVICE_ID_QEMU
;
57 static PCIBus
*first_bus
;
59 static void pcibus_save(QEMUFile
*f
, void *opaque
)
61 PCIBus
*bus
= (PCIBus
*)opaque
;
64 qemu_put_be32(f
, bus
->nirq
);
65 for (i
= 0; i
< bus
->nirq
; i
++)
66 qemu_put_be32(f
, bus
->irq_count
[i
]);
69 static int pcibus_load(QEMUFile
*f
, void *opaque
, int version_id
)
71 PCIBus
*bus
= (PCIBus
*)opaque
;
77 nirq
= qemu_get_be32(f
);
78 if (bus
->nirq
!= nirq
) {
79 fprintf(stderr
, "pcibus_load: nirq mismatch: src=%d dst=%d\n",
84 for (i
= 0; i
< nirq
; i
++)
85 bus
->irq_count
[i
] = qemu_get_be32(f
);
90 static void pci_bus_reset(void *opaque
)
92 PCIBus
*bus
= (PCIBus
*)opaque
;
95 for (i
= 0; i
< bus
->nirq
; i
++) {
96 bus
->irq_count
[i
] = 0;
98 for (i
= 0; i
< 256; i
++) {
100 memset(bus
->devices
[i
]->irq_state
, 0,
101 sizeof(bus
->devices
[i
]->irq_state
));
105 PCIBus
*pci_register_bus(DeviceState
*parent
, const char *name
,
106 pci_set_irq_fn set_irq
, pci_map_irq_fn map_irq
,
107 qemu_irq
*pic
, int devfn_min
, int nirq
)
112 bus
= FROM_QBUS(PCIBus
, qbus_create(BUS_TYPE_PCI
,
113 sizeof(PCIBus
) + (nirq
* sizeof(int)),
115 bus
->set_irq
= set_irq
;
116 bus
->map_irq
= map_irq
;
117 bus
->irq_opaque
= pic
;
118 bus
->devfn_min
= devfn_min
;
120 bus
->next
= first_bus
;
122 register_savevm("PCIBUS", nbus
++, 1, pcibus_save
, pcibus_load
, bus
);
123 qemu_register_reset(pci_bus_reset
, bus
);
127 static PCIBus
*pci_register_secondary_bus(PCIDevice
*dev
, pci_map_irq_fn map_irq
)
130 bus
= qemu_mallocz(sizeof(PCIBus
));
131 bus
->map_irq
= map_irq
;
132 bus
->parent_dev
= dev
;
133 bus
->next
= dev
->bus
->next
;
134 dev
->bus
->next
= bus
;
138 int pci_bus_num(PCIBus
*s
)
143 void pci_device_save(PCIDevice
*s
, QEMUFile
*f
)
147 qemu_put_be32(f
, 2); /* PCI device version */
148 qemu_put_buffer(f
, s
->config
, 256);
149 for (i
= 0; i
< 4; i
++)
150 qemu_put_be32(f
, s
->irq_state
[i
]);
153 int pci_device_load(PCIDevice
*s
, QEMUFile
*f
)
155 uint8_t config
[PCI_CONFIG_SPACE_SIZE
];
159 version_id
= qemu_get_be32(f
);
162 qemu_get_buffer(f
, config
, sizeof config
);
163 for (i
= 0; i
< sizeof config
; ++i
)
164 if ((config
[i
] ^ s
->config
[i
]) & s
->cmask
[i
] & ~s
->wmask
[i
])
166 memcpy(s
->config
, config
, sizeof config
);
168 pci_update_mappings(s
);
171 for (i
= 0; i
< 4; i
++)
172 s
->irq_state
[i
] = qemu_get_be32(f
);
176 static int pci_set_default_subsystem_id(PCIDevice
*pci_dev
)
180 id
= (void*)(&pci_dev
->config
[PCI_SUBVENDOR_ID
]);
181 id
[0] = cpu_to_le16(pci_default_sub_vendor_id
);
182 id
[1] = cpu_to_le16(pci_default_sub_device_id
);
187 * Parse [[<domain>:]<bus>:]<slot>, return -1 on error
189 static int pci_parse_devaddr(const char *addr
, int *domp
, int *busp
, unsigned *slotp
)
194 unsigned long dom
= 0, bus
= 0;
198 val
= strtoul(p
, &e
, 16);
204 val
= strtoul(p
, &e
, 16);
211 val
= strtoul(p
, &e
, 16);
217 if (dom
> 0xffff || bus
> 0xff || val
> 0x1f)
225 /* Note: QEMU doesn't implement domains other than 0 */
226 if (dom
!= 0 || pci_find_bus(bus
) == NULL
)
235 int pci_read_devaddr(Monitor
*mon
, const char *addr
, int *domp
, int *busp
,
238 /* strip legacy tag */
239 if (!strncmp(addr
, "pci_addr=", 9)) {
242 if (pci_parse_devaddr(addr
, domp
, busp
, slotp
)) {
243 monitor_printf(mon
, "Invalid pci address\n");
249 static PCIBus
*pci_get_bus_devfn(int *devfnp
, const char *devaddr
)
256 return pci_find_bus(0);
259 if (pci_parse_devaddr(devaddr
, &dom
, &bus
, &slot
) < 0) {
264 return pci_find_bus(bus
);
267 static void pci_init_cmask(PCIDevice
*dev
)
269 pci_set_word(dev
->cmask
+ PCI_VENDOR_ID
, 0xffff);
270 pci_set_word(dev
->cmask
+ PCI_DEVICE_ID
, 0xffff);
271 dev
->cmask
[PCI_STATUS
] = PCI_STATUS_CAP_LIST
;
272 dev
->cmask
[PCI_REVISION_ID
] = 0xff;
273 dev
->cmask
[PCI_CLASS_PROG
] = 0xff;
274 pci_set_word(dev
->cmask
+ PCI_CLASS_DEVICE
, 0xffff);
275 dev
->cmask
[PCI_HEADER_TYPE
] = 0xff;
276 dev
->cmask
[PCI_CAPABILITY_LIST
] = 0xff;
279 static void pci_init_wmask(PCIDevice
*dev
)
282 dev
->wmask
[PCI_CACHE_LINE_SIZE
] = 0xff;
283 dev
->wmask
[PCI_INTERRUPT_LINE
] = 0xff;
284 dev
->wmask
[PCI_COMMAND
] = PCI_COMMAND_IO
| PCI_COMMAND_MEMORY
285 | PCI_COMMAND_MASTER
;
286 for (i
= PCI_CONFIG_HEADER_SIZE
; i
< PCI_CONFIG_SPACE_SIZE
; ++i
)
287 dev
->wmask
[i
] = 0xff;
290 /* -1 for devfn means auto assign */
291 static PCIDevice
*do_pci_register_device(PCIDevice
*pci_dev
, PCIBus
*bus
,
292 const char *name
, int devfn
,
293 PCIConfigReadFunc
*config_read
,
294 PCIConfigWriteFunc
*config_write
)
297 for(devfn
= bus
->devfn_min
; devfn
< 256; devfn
+= 8) {
298 if (!bus
->devices
[devfn
])
303 } else if (bus
->devices
[devfn
]) {
307 pci_dev
->devfn
= devfn
;
308 pstrcpy(pci_dev
->name
, sizeof(pci_dev
->name
), name
);
309 memset(pci_dev
->irq_state
, 0, sizeof(pci_dev
->irq_state
));
310 pci_set_default_subsystem_id(pci_dev
);
311 pci_init_cmask(pci_dev
);
312 pci_init_wmask(pci_dev
);
315 config_read
= pci_default_read_config
;
317 config_write
= pci_default_write_config
;
318 pci_dev
->config_read
= config_read
;
319 pci_dev
->config_write
= config_write
;
320 bus
->devices
[devfn
] = pci_dev
;
321 pci_dev
->irq
= qemu_allocate_irqs(pci_set_irq
, pci_dev
, 4);
325 PCIDevice
*pci_register_device(PCIBus
*bus
, const char *name
,
326 int instance_size
, int devfn
,
327 PCIConfigReadFunc
*config_read
,
328 PCIConfigWriteFunc
*config_write
)
332 pci_dev
= qemu_mallocz(instance_size
);
333 pci_dev
= do_pci_register_device(pci_dev
, bus
, name
, devfn
,
334 config_read
, config_write
);
337 static target_phys_addr_t
pci_to_cpu_addr(target_phys_addr_t addr
)
339 return addr
+ pci_mem_base
;
342 static void pci_unregister_io_regions(PCIDevice
*pci_dev
)
347 for(i
= 0; i
< PCI_NUM_REGIONS
; i
++) {
348 r
= &pci_dev
->io_regions
[i
];
349 if (!r
->size
|| r
->addr
== -1)
351 if (r
->type
== PCI_ADDRESS_SPACE_IO
) {
352 isa_unassign_ioport(r
->addr
, r
->size
);
354 cpu_register_physical_memory(pci_to_cpu_addr(r
->addr
),
361 int pci_unregister_device(PCIDevice
*pci_dev
)
365 if (pci_dev
->unregister
)
366 ret
= pci_dev
->unregister(pci_dev
);
370 pci_unregister_io_regions(pci_dev
);
372 qemu_free_irqs(pci_dev
->irq
);
373 pci_dev
->bus
->devices
[pci_dev
->devfn
] = NULL
;
374 qdev_free(&pci_dev
->qdev
);
378 void pci_register_bar(PCIDevice
*pci_dev
, int region_num
,
379 uint32_t size
, int type
,
380 PCIMapIORegionFunc
*map_func
)
386 if ((unsigned int)region_num
>= PCI_NUM_REGIONS
)
389 if (size
& (size
-1)) {
390 fprintf(stderr
, "ERROR: PCI region size must be pow2 "
391 "type=0x%x, size=0x%x\n", type
, size
);
395 r
= &pci_dev
->io_regions
[region_num
];
399 r
->map_func
= map_func
;
402 if (region_num
== PCI_ROM_SLOT
) {
404 /* ROM enable bit is writeable */
407 addr
= 0x10 + region_num
* 4;
409 *(uint32_t *)(pci_dev
->config
+ addr
) = cpu_to_le32(type
);
410 *(uint32_t *)(pci_dev
->wmask
+ addr
) = cpu_to_le32(wmask
);
411 *(uint32_t *)(pci_dev
->cmask
+ addr
) = 0xffffffff;
414 static void pci_update_mappings(PCIDevice
*d
)
418 uint32_t last_addr
, new_addr
, config_ofs
;
420 cmd
= le16_to_cpu(*(uint16_t *)(d
->config
+ PCI_COMMAND
));
421 for(i
= 0; i
< PCI_NUM_REGIONS
; i
++) {
422 r
= &d
->io_regions
[i
];
423 if (i
== PCI_ROM_SLOT
) {
426 config_ofs
= 0x10 + i
* 4;
429 if (r
->type
& PCI_ADDRESS_SPACE_IO
) {
430 if (cmd
& PCI_COMMAND_IO
) {
431 new_addr
= le32_to_cpu(*(uint32_t *)(d
->config
+
433 new_addr
= new_addr
& ~(r
->size
- 1);
434 last_addr
= new_addr
+ r
->size
- 1;
435 /* NOTE: we have only 64K ioports on PC */
436 if (last_addr
<= new_addr
|| new_addr
== 0 ||
437 last_addr
>= 0x10000) {
444 if (cmd
& PCI_COMMAND_MEMORY
) {
445 new_addr
= le32_to_cpu(*(uint32_t *)(d
->config
+
447 /* the ROM slot has a specific enable bit */
448 if (i
== PCI_ROM_SLOT
&& !(new_addr
& 1))
450 new_addr
= new_addr
& ~(r
->size
- 1);
451 last_addr
= new_addr
+ r
->size
- 1;
452 /* NOTE: we do not support wrapping */
453 /* XXX: as we cannot support really dynamic
454 mappings, we handle specific values as invalid
456 if (last_addr
<= new_addr
|| new_addr
== 0 ||
465 /* now do the real mapping */
466 if (new_addr
!= r
->addr
) {
468 if (r
->type
& PCI_ADDRESS_SPACE_IO
) {
470 /* NOTE: specific hack for IDE in PC case:
471 only one byte must be mapped. */
472 class = d
->config
[0x0a] | (d
->config
[0x0b] << 8);
473 if (class == 0x0101 && r
->size
== 4) {
474 isa_unassign_ioport(r
->addr
+ 2, 1);
476 isa_unassign_ioport(r
->addr
, r
->size
);
479 cpu_register_physical_memory(pci_to_cpu_addr(r
->addr
),
482 qemu_unregister_coalesced_mmio(r
->addr
, r
->size
);
487 r
->map_func(d
, i
, r
->addr
, r
->size
, r
->type
);
494 uint32_t pci_default_read_config(PCIDevice
*d
,
495 uint32_t address
, int len
)
502 if (address
<= 0xfc) {
503 val
= le32_to_cpu(*(uint32_t *)(d
->config
+ address
));
508 if (address
<= 0xfe) {
509 val
= le16_to_cpu(*(uint16_t *)(d
->config
+ address
));
514 val
= d
->config
[address
];
520 void pci_default_write_config(PCIDevice
*d
, uint32_t addr
, uint32_t val
, int l
)
522 uint8_t orig
[PCI_CONFIG_SPACE_SIZE
];
525 /* not efficient, but simple */
526 memcpy(orig
, d
->config
, PCI_CONFIG_SPACE_SIZE
);
527 for(i
= 0; i
< l
&& addr
< PCI_CONFIG_SPACE_SIZE
; val
>>= 8, ++i
, ++addr
) {
528 uint8_t wmask
= d
->wmask
[addr
];
529 d
->config
[addr
] = (d
->config
[addr
] & ~wmask
) | (val
& wmask
);
531 if (memcmp(orig
+ PCI_BASE_ADDRESS_0
, d
->config
+ PCI_BASE_ADDRESS_0
, 24)
532 || ((orig
[PCI_COMMAND
] ^ d
->config
[PCI_COMMAND
])
533 & (PCI_COMMAND_MEMORY
| PCI_COMMAND_IO
)))
534 pci_update_mappings(d
);
537 void pci_data_write(void *opaque
, uint32_t addr
, uint32_t val
, int len
)
541 int config_addr
, bus_num
;
543 #if defined(DEBUG_PCI) && 0
544 printf("pci_data_write: addr=%08x val=%08x len=%d\n",
547 bus_num
= (addr
>> 16) & 0xff;
548 while (s
&& s
->bus_num
!= bus_num
)
552 pci_dev
= s
->devices
[(addr
>> 8) & 0xff];
555 config_addr
= addr
& 0xff;
556 #if defined(DEBUG_PCI)
557 printf("pci_config_write: %s: addr=%02x val=%08x len=%d\n",
558 pci_dev
->name
, config_addr
, val
, len
);
560 pci_dev
->config_write(pci_dev
, config_addr
, val
, len
);
563 uint32_t pci_data_read(void *opaque
, uint32_t addr
, int len
)
567 int config_addr
, bus_num
;
570 bus_num
= (addr
>> 16) & 0xff;
571 while (s
&& s
->bus_num
!= bus_num
)
575 pci_dev
= s
->devices
[(addr
>> 8) & 0xff];
592 config_addr
= addr
& 0xff;
593 val
= pci_dev
->config_read(pci_dev
, config_addr
, len
);
594 #if defined(DEBUG_PCI)
595 printf("pci_config_read: %s: addr=%02x val=%08x len=%d\n",
596 pci_dev
->name
, config_addr
, val
, len
);
599 #if defined(DEBUG_PCI) && 0
600 printf("pci_data_read: addr=%08x val=%08x len=%d\n",
606 /***********************************************************/
607 /* generic PCI irq support */
609 /* 0 <= irq_num <= 3. level must be 0 or 1 */
610 static void pci_set_irq(void *opaque
, int irq_num
, int level
)
612 PCIDevice
*pci_dev
= (PCIDevice
*)opaque
;
616 change
= level
- pci_dev
->irq_state
[irq_num
];
620 pci_dev
->irq_state
[irq_num
] = level
;
623 irq_num
= bus
->map_irq(pci_dev
, irq_num
);
626 pci_dev
= bus
->parent_dev
;
628 bus
->irq_count
[irq_num
] += change
;
629 bus
->set_irq(bus
->irq_opaque
, irq_num
, bus
->irq_count
[irq_num
] != 0);
632 /***********************************************************/
633 /* monitor info on PCI */
640 static const pci_class_desc pci_class_descriptions
[] =
642 { 0x0100, "SCSI controller"},
643 { 0x0101, "IDE controller"},
644 { 0x0102, "Floppy controller"},
645 { 0x0103, "IPI controller"},
646 { 0x0104, "RAID controller"},
647 { 0x0106, "SATA controller"},
648 { 0x0107, "SAS controller"},
649 { 0x0180, "Storage controller"},
650 { 0x0200, "Ethernet controller"},
651 { 0x0201, "Token Ring controller"},
652 { 0x0202, "FDDI controller"},
653 { 0x0203, "ATM controller"},
654 { 0x0280, "Network controller"},
655 { 0x0300, "VGA controller"},
656 { 0x0301, "XGA controller"},
657 { 0x0302, "3D controller"},
658 { 0x0380, "Display controller"},
659 { 0x0400, "Video controller"},
660 { 0x0401, "Audio controller"},
662 { 0x0480, "Multimedia controller"},
663 { 0x0500, "RAM controller"},
664 { 0x0501, "Flash controller"},
665 { 0x0580, "Memory controller"},
666 { 0x0600, "Host bridge"},
667 { 0x0601, "ISA bridge"},
668 { 0x0602, "EISA bridge"},
669 { 0x0603, "MC bridge"},
670 { 0x0604, "PCI bridge"},
671 { 0x0605, "PCMCIA bridge"},
672 { 0x0606, "NUBUS bridge"},
673 { 0x0607, "CARDBUS bridge"},
674 { 0x0608, "RACEWAY bridge"},
676 { 0x0c03, "USB controller"},
680 static void pci_info_device(PCIDevice
*d
)
682 Monitor
*mon
= cur_mon
;
685 const pci_class_desc
*desc
;
687 monitor_printf(mon
, " Bus %2d, device %3d, function %d:\n",
688 d
->bus
->bus_num
, d
->devfn
>> 3, d
->devfn
& 7);
689 class = le16_to_cpu(*((uint16_t *)(d
->config
+ PCI_CLASS_DEVICE
)));
690 monitor_printf(mon
, " ");
691 desc
= pci_class_descriptions
;
692 while (desc
->desc
&& class != desc
->class)
695 monitor_printf(mon
, "%s", desc
->desc
);
697 monitor_printf(mon
, "Class %04x", class);
699 monitor_printf(mon
, ": PCI device %04x:%04x\n",
700 le16_to_cpu(*((uint16_t *)(d
->config
+ PCI_VENDOR_ID
))),
701 le16_to_cpu(*((uint16_t *)(d
->config
+ PCI_DEVICE_ID
))));
703 if (d
->config
[PCI_INTERRUPT_PIN
] != 0) {
704 monitor_printf(mon
, " IRQ %d.\n",
705 d
->config
[PCI_INTERRUPT_LINE
]);
707 if (class == 0x0604) {
708 monitor_printf(mon
, " BUS %d.\n", d
->config
[0x19]);
710 for(i
= 0;i
< PCI_NUM_REGIONS
; i
++) {
711 r
= &d
->io_regions
[i
];
713 monitor_printf(mon
, " BAR%d: ", i
);
714 if (r
->type
& PCI_ADDRESS_SPACE_IO
) {
715 monitor_printf(mon
, "I/O at 0x%04x [0x%04x].\n",
716 r
->addr
, r
->addr
+ r
->size
- 1);
718 monitor_printf(mon
, "32 bit memory at 0x%08x [0x%08x].\n",
719 r
->addr
, r
->addr
+ r
->size
- 1);
723 if (class == 0x0604 && d
->config
[0x19] != 0) {
724 pci_for_each_device(d
->config
[0x19], pci_info_device
);
728 void pci_for_each_device(int bus_num
, void (*fn
)(PCIDevice
*d
))
730 PCIBus
*bus
= first_bus
;
734 while (bus
&& bus
->bus_num
!= bus_num
)
737 for(devfn
= 0; devfn
< 256; devfn
++) {
738 d
= bus
->devices
[devfn
];
745 void pci_info(Monitor
*mon
)
747 pci_for_each_device(0, pci_info_device
);
750 PCIDevice
*pci_create(const char *name
, const char *devaddr
)
756 bus
= pci_get_bus_devfn(&devfn
, devaddr
);
758 fprintf(stderr
, "Invalid PCI device address %s for device %s\n",
763 dev
= qdev_create(&bus
->qbus
, name
);
764 qdev_set_prop_int(dev
, "devfn", devfn
);
765 return (PCIDevice
*)dev
;
768 static const char * const pci_nic_models
[] = {
780 static const char * const pci_nic_names
[] = {
792 /* Initialize a PCI NIC. */
793 PCIDevice
*pci_nic_init(NICInfo
*nd
, const char *default_model
,
794 const char *default_devaddr
)
796 const char *devaddr
= nd
->devaddr
? nd
->devaddr
: default_devaddr
;
801 qemu_check_nic_model_list(nd
, pci_nic_models
, default_model
);
803 for (i
= 0; pci_nic_models
[i
]; i
++) {
804 if (strcmp(nd
->model
, pci_nic_models
[i
]) == 0) {
805 pci_dev
= pci_create(pci_nic_names
[i
], devaddr
);
806 dev
= &pci_dev
->qdev
;
807 qdev_set_netdev(dev
, nd
);
822 static void pci_bridge_write_config(PCIDevice
*d
,
823 uint32_t address
, uint32_t val
, int len
)
825 PCIBridge
*s
= (PCIBridge
*)d
;
827 pci_default_write_config(d
, address
, val
, len
);
828 s
->bus
->bus_num
= d
->config
[PCI_SECONDARY_BUS
];
831 PCIBus
*pci_find_bus(int bus_num
)
833 PCIBus
*bus
= first_bus
;
835 while (bus
&& bus
->bus_num
!= bus_num
)
841 PCIDevice
*pci_find_device(int bus_num
, int slot
, int function
)
843 PCIBus
*bus
= pci_find_bus(bus_num
);
848 return bus
->devices
[PCI_DEVFN(slot
, function
)];
851 PCIBus
*pci_bridge_init(PCIBus
*bus
, int devfn
, uint16_t vid
, uint16_t did
,
852 pci_map_irq_fn map_irq
, const char *name
)
855 s
= (PCIBridge
*)pci_register_device(bus
, name
, sizeof(PCIBridge
),
856 devfn
, NULL
, pci_bridge_write_config
);
858 pci_config_set_vendor_id(s
->dev
.config
, vid
);
859 pci_config_set_device_id(s
->dev
.config
, did
);
861 s
->dev
.config
[0x04] = 0x06; // command = bus master, pci mem
862 s
->dev
.config
[0x05] = 0x00;
863 s
->dev
.config
[0x06] = 0xa0; // status = fast back-to-back, 66MHz, no error
864 s
->dev
.config
[0x07] = 0x00; // status = fast devsel
865 s
->dev
.config
[0x08] = 0x00; // revision
866 s
->dev
.config
[0x09] = 0x00; // programming i/f
867 pci_config_set_class(s
->dev
.config
, PCI_CLASS_BRIDGE_PCI
);
868 s
->dev
.config
[0x0D] = 0x10; // latency_timer
869 s
->dev
.config
[PCI_HEADER_TYPE
] =
870 PCI_HEADER_TYPE_MULTI_FUNCTION
| PCI_HEADER_TYPE_BRIDGE
; // header_type
871 s
->dev
.config
[0x1E] = 0xa0; // secondary status
873 s
->bus
= pci_register_secondary_bus(&s
->dev
, map_irq
);
877 static void pci_qdev_init(DeviceState
*qdev
, DeviceInfo
*base
)
879 PCIDevice
*pci_dev
= (PCIDevice
*)qdev
;
880 PCIDeviceInfo
*info
= container_of(base
, PCIDeviceInfo
, qdev
);
884 bus
= FROM_QBUS(PCIBus
, qdev_get_parent_bus(qdev
));
885 devfn
= qdev_get_prop_int(qdev
, "devfn", -1);
886 pci_dev
= do_pci_register_device(pci_dev
, bus
, "FIXME", devfn
,
887 info
->config_read
, info
->config_write
);
892 void pci_qdev_register(PCIDeviceInfo
*info
)
894 info
->qdev
.init
= pci_qdev_init
;
895 info
->qdev
.bus_type
= BUS_TYPE_PCI
;
896 qdev_register(&info
->qdev
);
899 void pci_qdev_register_many(PCIDeviceInfo
*info
)
901 while (info
->qdev
.name
) {
902 pci_qdev_register(info
);
907 PCIDevice
*pci_create_simple(PCIBus
*bus
, int devfn
, const char *name
)
911 dev
= qdev_create(&bus
->qbus
, name
);
912 qdev_set_prop_int(dev
, "devfn", devfn
);
915 return (PCIDevice
*)dev
;
918 static int pci_find_space(PCIDevice
*pdev
, uint8_t size
)
920 int offset
= PCI_CONFIG_HEADER_SIZE
;
922 for (i
= PCI_CONFIG_HEADER_SIZE
; i
< PCI_CONFIG_SPACE_SIZE
; ++i
)
925 else if (i
- offset
+ 1 == size
)
930 static uint8_t pci_find_capability_list(PCIDevice
*pdev
, uint8_t cap_id
,
935 if (!(pdev
->config
[PCI_STATUS
] & PCI_STATUS_CAP_LIST
))
938 for (prev
= PCI_CAPABILITY_LIST
; (next
= pdev
->config
[prev
]);
939 prev
= next
+ PCI_CAP_LIST_NEXT
)
940 if (pdev
->config
[next
+ PCI_CAP_LIST_ID
] == cap_id
)
948 /* Reserve space and add capability to the linked list in pci config space */
949 int pci_add_capability(PCIDevice
*pdev
, uint8_t cap_id
, uint8_t size
)
951 uint8_t offset
= pci_find_space(pdev
, size
);
952 uint8_t *config
= pdev
->config
+ offset
;
955 config
[PCI_CAP_LIST_ID
] = cap_id
;
956 config
[PCI_CAP_LIST_NEXT
] = pdev
->config
[PCI_CAPABILITY_LIST
];
957 pdev
->config
[PCI_CAPABILITY_LIST
] = offset
;
958 pdev
->config
[PCI_STATUS
] |= PCI_STATUS_CAP_LIST
;
959 memset(pdev
->used
+ offset
, 0xFF, size
);
960 /* Make capability read-only by default */
961 memset(pdev
->wmask
+ offset
, 0, size
);
962 /* Check capability by default */
963 memset(pdev
->cmask
+ offset
, 0xFF, size
);
967 /* Unlink capability from the pci config space. */
968 void pci_del_capability(PCIDevice
*pdev
, uint8_t cap_id
, uint8_t size
)
970 uint8_t prev
, offset
= pci_find_capability_list(pdev
, cap_id
, &prev
);
973 pdev
->config
[prev
] = pdev
->config
[offset
+ PCI_CAP_LIST_NEXT
];
974 /* Make capability writeable again */
975 memset(pdev
->wmask
+ offset
, 0xff, size
);
976 /* Clear cmask as device-specific registers can't be checked */
977 memset(pdev
->cmask
+ offset
, 0, size
);
978 memset(pdev
->used
+ offset
, 0, size
);
980 if (!pdev
->config
[PCI_CAPABILITY_LIST
])
981 pdev
->config
[PCI_STATUS
] &= ~PCI_STATUS_CAP_LIST
;
984 /* Reserve space for capability at a known offset (to call after load). */
985 void pci_reserve_capability(PCIDevice
*pdev
, uint8_t offset
, uint8_t size
)
987 memset(pdev
->used
+ offset
, 0xff, size
);
990 uint8_t pci_find_capability(PCIDevice
*pdev
, uint8_t cap_id
)
992 return pci_find_capability_list(pdev
, cap_id
, NULL
);