e6e899dde9
Signed-off-by: Luc Verhaegen <libv@skynet.be> Acked-by: Stefan Reinauer <stepan@coresystems.de> git-svn-id: svn://svn.coreboot.org/coreboot/trunk@4312 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
170 lines
3.7 KiB
C
170 lines
3.7 KiB
C
#include <stdio.h>
|
|
#include <pci/pci.h>
|
|
#include "pci.h"
|
|
|
|
#ifdef PCI_LIB_VERSION
|
|
#define LIBPCI_CHECK_VERSION(major,minor,micro) \
|
|
((((major) << 16) | ((minor) << 8) | (micro)) <= PCI_LIB_VERSION)
|
|
#else
|
|
#define LIBPCI_CHECK_VERSION(major,minor,micro) \
|
|
( (LIBPCI_MAJOR_VERSION > (major)) || \
|
|
(LIBPCI_MAJOR_VERSION == (major) && LIBPCI_MINOR_VERSION > (minor)) || \
|
|
(LIBPCI_MAJOR_VERSION == (major) && LIBPCI_MINOR_VERSION == (minor)) && \
|
|
LIBPCI_MICRO_VERSION >= (micro) )
|
|
#endif
|
|
|
|
#define PCITAG struct pci_filter *
|
|
|
|
#define DEBUG_PCI 1
|
|
|
|
struct pci_access *pacc;
|
|
struct pci_dev *dev;
|
|
|
|
struct pci_filter ltag;
|
|
|
|
|
|
int pciNumBuses = 0;
|
|
|
|
int pciInit(void)
|
|
{
|
|
pacc = pci_alloc();
|
|
|
|
pci_init(pacc);
|
|
pci_scan_bus(pacc);
|
|
for (dev = pacc->devices; dev; dev = dev->next) {
|
|
pci_fill_info(dev, PCI_FILL_IDENT | PCI_FILL_BASES);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int pciExit(void)
|
|
{
|
|
pci_cleanup(pacc);
|
|
return 0;
|
|
}
|
|
|
|
PCITAG findPci(unsigned short bx)
|
|
{
|
|
PCITAG tag = <ag;
|
|
|
|
int bus = (bx >> 8) & 0xFF;
|
|
int slot = (bx >> 3) & 0x1F;
|
|
int func = bx & 0x7;
|
|
|
|
tag->bus = bus;
|
|
tag->slot = slot;
|
|
tag->func = func;
|
|
|
|
#if LIBPCI_CHECK_VERSION(2,1,99)
|
|
if (pci_get_dev(pacc, 0, bus, slot, func))
|
|
#else
|
|
if (pci_get_dev(pacc, bus, slot, func))
|
|
#endif
|
|
return tag;
|
|
|
|
return NULL;
|
|
}
|
|
|
|
u32 pciSlotBX(PCITAG tag)
|
|
{
|
|
return (tag->bus << 8) | (tag->slot << 3) | (tag->func);
|
|
}
|
|
|
|
u8 pciReadByte(PCITAG tag, u32 idx)
|
|
{
|
|
struct pci_dev *d;
|
|
#if LIBPCI_CHECK_VERSION(2,1,99)
|
|
if ((d = pci_get_dev(pacc, 0, tag->bus, tag->slot, tag->func)))
|
|
#else
|
|
if ((d = pci_get_dev(pacc, tag->bus, tag->slot, tag->func)))
|
|
#endif
|
|
return pci_read_byte(d, idx);
|
|
#ifdef DEBUG_PCI
|
|
printf("PCI: device not found while read byte (%x:%x.%x)\n",
|
|
tag->bus, tag->slot, tag->func);
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
u16 pciReadWord(PCITAG tag, u32 idx)
|
|
{
|
|
struct pci_dev *d;
|
|
#if LIBPCI_CHECK_VERSION(2,1,99)
|
|
if ((d = pci_get_dev(pacc, 0, tag->bus, tag->slot, tag->func)))
|
|
#else
|
|
if ((d = pci_get_dev(pacc, tag->bus, tag->slot, tag->func)))
|
|
#endif
|
|
return pci_read_word(d, idx);
|
|
#ifdef DEBUG_PCI
|
|
printf("PCI: device not found while read word (%x:%x.%x)\n",
|
|
tag->bus, tag->slot, tag->func);
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
u32 pciReadLong(PCITAG tag, u32 idx)
|
|
{
|
|
struct pci_dev *d;
|
|
#if LIBPCI_CHECK_VERSION(2,1,99)
|
|
if ((d = pci_get_dev(pacc, 0, tag->bus, tag->slot, tag->func)))
|
|
#else
|
|
if ((d = pci_get_dev(pacc, tag->bus, tag->slot, tag->func)))
|
|
#endif
|
|
return pci_read_long(d, idx);
|
|
#ifdef DEBUG_PCI
|
|
printf("PCI: device not found while read long (%x:%x.%x)\n",
|
|
tag->bus, tag->slot, tag->func);
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
|
|
void pciWriteLong(PCITAG tag, u32 idx, u32 data)
|
|
{
|
|
struct pci_dev *d;
|
|
#if LIBPCI_CHECK_VERSION(2,1,99)
|
|
if ((d = pci_get_dev(pacc, 0, tag->bus, tag->slot, tag->func)))
|
|
#else
|
|
if ((d = pci_get_dev(pacc, tag->bus, tag->slot, tag->func)))
|
|
#endif
|
|
pci_write_long(d, idx, data);
|
|
#ifdef DEBUG_PCI
|
|
else
|
|
printf("PCI: device not found while write long (%x:%x.%x)\n",
|
|
tag->bus, tag->slot, tag->func);
|
|
#endif
|
|
}
|
|
|
|
void pciWriteWord(PCITAG tag, u32 idx, u16 data)
|
|
{
|
|
struct pci_dev *d;
|
|
#if LIBPCI_CHECK_VERSION(2,1,99)
|
|
if ((d = pci_get_dev(pacc, 0, tag->bus, tag->slot, tag->func)))
|
|
#else
|
|
if ((d = pci_get_dev(pacc, tag->bus, tag->slot, tag->func)))
|
|
#endif
|
|
pci_write_word(d, idx, data);
|
|
#ifdef DEBUG_PCI
|
|
else
|
|
printf("PCI: device not found while write word (%x:%x.%x)\n",
|
|
tag->bus, tag->slot, tag->func);
|
|
#endif
|
|
|
|
}
|
|
|
|
void pciWriteByte(PCITAG tag, u32 idx, u8 data)
|
|
{
|
|
struct pci_dev *d;
|
|
#if LIBPCI_CHECK_VERSION(2,1,99)
|
|
if ((d = pci_get_dev(pacc, 0, tag->bus, tag->slot, tag->func)))
|
|
#else
|
|
if ((d = pci_get_dev(pacc, tag->bus, tag->slot, tag->func)))
|
|
#endif
|
|
pci_write_long(d, idx, data);
|
|
#ifdef DEBUG_PCI
|
|
else
|
|
printf("PCI: device not found while write long (%x:%x.%x)\n",
|
|
tag->bus, tag->slot, tag->func);
|
|
#endif
|
|
}
|