1
// PCI config space access functions.
3
// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
4
// Copyright (C) 2002 MandrakeSoft S.A.
6
// This file may be distributed under the terms of the GNU LGPLv3 license.
8
#include "pci.h" // pci_config_writel
9
#include "ioport.h" // outl
10
#include "util.h" // dprintf
11
#include "config.h" // CONFIG_*
12
#include "pci_regs.h" // PCI_VENDOR_ID
13
#include "pci_ids.h" // PCI_CLASS_DISPLAY_VGA
15
void pci_config_writel(u16 bdf, u32 addr, u32 val)
17
outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD);
18
outl(val, PORT_PCI_DATA);
21
void pci_config_writew(u16 bdf, u32 addr, u16 val)
23
outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD);
24
outw(val, PORT_PCI_DATA + (addr & 2));
27
void pci_config_writeb(u16 bdf, u32 addr, u8 val)
29
outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD);
30
outb(val, PORT_PCI_DATA + (addr & 3));
33
u32 pci_config_readl(u16 bdf, u32 addr)
35
outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD);
36
return inl(PORT_PCI_DATA);
39
u16 pci_config_readw(u16 bdf, u32 addr)
41
outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD);
42
return inw(PORT_PCI_DATA + (addr & 2));
45
u8 pci_config_readb(u16 bdf, u32 addr)
47
outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD);
48
return inb(PORT_PCI_DATA + (addr & 3));
52
pci_config_maskw(u16 bdf, u32 addr, u16 off, u16 on)
54
u16 val = pci_config_readw(bdf, addr);
55
val = (val & ~off) | on;
56
pci_config_writew(bdf, addr, val);
59
// Helper function for foreachpci() macro - return next device
61
pci_next(int bdf, int *pmax)
63
if (pci_bdf_to_fn(bdf) == 1
64
&& (pci_config_readb(bdf-1, PCI_HEADER_TYPE) & 0x80) == 0)
65
// Last found device wasn't a multi-function device - skip to
72
if (CONFIG_PCI_ROOT1 && bdf <= (CONFIG_PCI_ROOT1 << 8))
73
bdf = CONFIG_PCI_ROOT1 << 8;
74
else if (CONFIG_PCI_ROOT2 && bdf <= (CONFIG_PCI_ROOT2 << 8))
75
bdf = CONFIG_PCI_ROOT2 << 8;
78
*pmax = max = bdf + 0x0100;
81
u16 v = pci_config_readw(bdf, PCI_VENDOR_ID);
82
if (v != 0x0000 && v != 0xffff)
86
if (pci_bdf_to_fn(bdf) == 0)
92
// Check if found device is a bridge.
93
u32 v = pci_config_readb(bdf, PCI_HEADER_TYPE);
95
if (v == PCI_HEADER_TYPE_BRIDGE || v == PCI_HEADER_TYPE_CARDBUS) {
96
v = pci_config_readl(bdf, PCI_PRIMARY_BUS);
97
int newmax = (v & 0xff00) + 0x0100;
105
// Find a vga device with legacy address decoding enabled.
109
int bdf = 0x0000, max = 0x0100;
112
if (CONFIG_PCI_ROOT1 && bdf <= (CONFIG_PCI_ROOT1 << 8))
113
bdf = CONFIG_PCI_ROOT1 << 8;
114
else if (CONFIG_PCI_ROOT2 && bdf <= (CONFIG_PCI_ROOT2 << 8))
115
bdf = CONFIG_PCI_ROOT2 << 8;
121
u16 cls = pci_config_readw(bdf, PCI_CLASS_DEVICE);
122
if (cls == 0x0000 || cls == 0xffff) {
123
// Device not present.
124
if (pci_bdf_to_fn(bdf) == 0)
130
if (cls == PCI_CLASS_DISPLAY_VGA) {
131
u16 cmd = pci_config_readw(bdf, PCI_COMMAND);
132
if (cmd & PCI_COMMAND_IO && cmd & PCI_COMMAND_MEMORY)
133
// Found active vga card
137
// Check if device is a bridge.
138
u8 hdr = pci_config_readb(bdf, PCI_HEADER_TYPE);
140
if (ht == PCI_HEADER_TYPE_BRIDGE || ht == PCI_HEADER_TYPE_CARDBUS) {
141
u32 ctrl = pci_config_readb(bdf, PCI_BRIDGE_CONTROL);
142
if (ctrl & PCI_BRIDGE_CTL_VGA) {
143
// Found a VGA enabled bridge.
144
u32 pbus = pci_config_readl(bdf, PCI_PRIMARY_BUS);
145
bdf = (pbus & 0xff00);
151
if (pci_bdf_to_fn(bdf) == 0 && (hdr & 0x80) == 0)
152
// Last found device wasn't a multi-function device - skip to
160
// Search for a device with the specified vendor and device ids.
162
pci_find_device(u16 vendid, u16 devid)
164
u32 id = (devid << 16) | vendid;
166
foreachpci(bdf, max) {
167
u32 v = pci_config_readl(bdf, PCI_VENDOR_ID);
174
// Search for a device with the specified class id.
176
pci_find_class(u16 classid)
179
foreachpci(bdf, max) {
180
u16 v = pci_config_readw(bdf, PCI_CLASS_DEVICE);
187
int pci_init_device(const struct pci_device_id *ids, u16 bdf, void *arg)
189
u16 vendor_id = pci_config_readw(bdf, PCI_VENDOR_ID);
190
u16 device_id = pci_config_readw(bdf, PCI_DEVICE_ID);
191
u16 class = pci_config_readw(bdf, PCI_CLASS_DEVICE);
193
while (ids->vendid || ids->class_mask) {
194
if ((ids->vendid == PCI_ANY_ID || ids->vendid == vendor_id) &&
195
(ids->devid == PCI_ANY_ID || ids->devid == device_id) &&
196
!((ids->class ^ class) & ids->class_mask)) {