#include <sys/types.h>
#include <sys/sunddi.h>
#include <sys/pci.h>
#include <sys/pci_impl.h>
#include <sys/pci_cfgspace_impl.h>
#define PCI_MAX_DEVS_2 16
static uint8_t
pci_mech2_config_enable(uchar_t bus, uchar_t function)
{
uint8_t old;
mutex_enter(&pcicfg_mutex);
old = inb(PCI_CSE_PORT);
outb(PCI_CSE_PORT,
PCI_MECH2_CONFIG_ENABLE | ((function & PCI_FUNC_MASK) << 1));
outb(PCI_FORW_PORT, bus);
return (old);
}
static void
pci_mech2_config_restore(uint8_t oldstatus)
{
outb(PCI_CSE_PORT, oldstatus);
mutex_exit(&pcicfg_mutex);
}
uint8_t
pci_mech2_getb(int bus, int device, int function, int reg)
{
uint8_t tmp;
uint8_t val;
if (device >= PCI_MAX_DEVS_2 || reg > pci_iocfg_max_offset)
return (PCI_EINVAL8);
tmp = pci_mech2_config_enable(bus, function);
val = inb(PCI_CADDR2(device, reg));
pci_mech2_config_restore(tmp);
return (val);
}
uint16_t
pci_mech2_getw(int bus, int device, int function, int reg)
{
uint8_t tmp;
uint16_t val;
if (device >= PCI_MAX_DEVS_2 || reg > pci_iocfg_max_offset)
return (PCI_EINVAL16);
tmp = pci_mech2_config_enable(bus, function);
val = inw(PCI_CADDR2(device, reg));
pci_mech2_config_restore(tmp);
return (val);
}
uint32_t
pci_mech2_getl(int bus, int device, int function, int reg)
{
uint8_t tmp;
uint32_t val;
if (device >= PCI_MAX_DEVS_2 || reg > pci_iocfg_max_offset)
return (PCI_EINVAL32);
tmp = pci_mech2_config_enable(bus, function);
val = inl(PCI_CADDR2(device, reg));
pci_mech2_config_restore(tmp);
return (val);
}
void
pci_mech2_putb(int bus, int device, int function, int reg, uint8_t val)
{
uint8_t tmp;
if (device >= PCI_MAX_DEVS_2 || reg > pci_iocfg_max_offset)
return;
tmp = pci_mech2_config_enable(bus, function);
outb(PCI_CADDR2(device, reg), val);
pci_mech2_config_restore(tmp);
}
void
pci_mech2_putw(int bus, int device, int function, int reg, uint16_t val)
{
uint8_t tmp;
if (device >= PCI_MAX_DEVS_2 || reg > pci_iocfg_max_offset)
return;
tmp = pci_mech2_config_enable(bus, function);
outw(PCI_CADDR2(device, reg), val);
pci_mech2_config_restore(tmp);
}
void
pci_mech2_putl(int bus, int device, int function, int reg, uint32_t val)
{
uint8_t tmp;
if (device >= PCI_MAX_DEVS_2 || reg > pci_iocfg_max_offset)
return;
tmp = pci_mech2_config_enable(bus, function);
outl(PCI_CADDR2(device, reg), val);
pci_mech2_config_restore(tmp);
}