#include <sys/param.h>
#include <sys/systm.h>
#include <sys/malloc.h>
#include <machine/intr.h>
#include <machine/bus.h>
#include <dev/pci/pcivar.h>
#include <i386/pci/pcibiosvar.h>
#include <i386/pci/opti82c558reg.h>
int opti82c558_getclink(pciintr_icu_handle_t, int, int *);
int opti82c558_get_intr(pciintr_icu_handle_t, int, int *);
int opti82c558_set_intr(pciintr_icu_handle_t, int, int);
int opti82c558_get_trigger(pciintr_icu_handle_t, int, int *);
int opti82c558_set_trigger(pciintr_icu_handle_t, int, int);
const struct pciintr_icu opti82c558_pci_icu = {
opti82c558_getclink,
opti82c558_get_intr,
opti82c558_set_intr,
opti82c558_get_trigger,
opti82c558_set_trigger,
};
struct opti82c558_handle {
pci_chipset_tag_t ph_pc;
pcitag_t ph_tag;
};
static const int viper_pirq_decode[] = {
-1, 5, 9, 10, 11, 12, 14, 15
};
static const int viper_pirq_encode[] = {
-1,
-1,
-1,
-1,
-1,
VIPER_PIRQ_5,
-1,
-1,
-1,
VIPER_PIRQ_9,
VIPER_PIRQ_10,
VIPER_PIRQ_11,
VIPER_PIRQ_12,
-1,
VIPER_PIRQ_14,
VIPER_PIRQ_15,
};
int
opti82c558_init(pci_chipset_tag_t pc, bus_space_tag_t iot, pcitag_t tag,
pciintr_icu_tag_t *ptagp, pciintr_icu_handle_t *phandp)
{
struct opti82c558_handle *ph;
ph = malloc(sizeof(*ph), M_DEVBUF, M_NOWAIT);
if (ph == NULL)
return (1);
ph->ph_pc = pc;
ph->ph_tag = tag;
*ptagp = &opti82c558_pci_icu;
*phandp = ph;
return (0);
}
int
opti82c558_getclink(pciintr_icu_handle_t v, int link, int *clinkp)
{
if (VIPER_LEGAL_LINK(link - 1)) {
*clinkp = link - 1;
return (0);
}
return (1);
}
int
opti82c558_get_intr(pciintr_icu_handle_t v, int clink, int *irqp)
{
struct opti82c558_handle *ph = v;
pcireg_t reg;
int val;
if (VIPER_LEGAL_LINK(clink) == 0)
return (1);
reg = pci_conf_read(ph->ph_pc, ph->ph_tag, VIPER_CFG_PIRQ);
val = VIPER_PIRQ(reg, clink);
*irqp = (val == VIPER_PIRQ_NONE) ? 0xff : viper_pirq_decode[val];
return (0);
}
int
opti82c558_set_intr(pciintr_icu_handle_t v, int clink, int irq)
{
struct opti82c558_handle *ph = v;
int shift;
pcireg_t reg;
if (VIPER_LEGAL_LINK(clink) == 0 || VIPER_LEGAL_IRQ(irq) == 0)
return (1);
reg = pci_conf_read(ph->ph_pc, ph->ph_tag, VIPER_CFG_PIRQ);
shift = VIPER_PIRQ_SELECT_SHIFT * clink;
reg &= ~(VIPER_PIRQ_SELECT_MASK << shift);
reg |= (viper_pirq_encode[irq] << shift);
pci_conf_write(ph->ph_pc, ph->ph_tag, VIPER_CFG_PIRQ, reg);
return (0);
}
int
opti82c558_get_trigger(pciintr_icu_handle_t v, int irq, int *triggerp)
{
struct opti82c558_handle *ph = v;
pcireg_t reg;
if (VIPER_LEGAL_IRQ(irq) == 0) {
*triggerp = IST_EDGE;
return (0);
}
reg = pci_conf_read(ph->ph_pc, ph->ph_tag, VIPER_CFG_PIRQ);
if ((reg >> (VIPER_CFG_TRIGGER_SHIFT + viper_pirq_encode[irq])) & 1)
*triggerp = IST_LEVEL;
else
*triggerp = IST_EDGE;
return (0);
}
int
opti82c558_set_trigger(pciintr_icu_handle_t v, int irq, int trigger)
{
struct opti82c558_handle *ph = v;
int shift;
pcireg_t reg;
if (VIPER_LEGAL_IRQ(irq) == 0) {
return ((trigger != IST_LEVEL) ? 0 : 1);
}
reg = pci_conf_read(ph->ph_pc, ph->ph_tag, VIPER_CFG_PIRQ);
shift = (VIPER_CFG_TRIGGER_SHIFT + viper_pirq_encode[irq]);
if (trigger == IST_LEVEL)
reg |= (1 << shift);
else
reg &= ~(1 << shift);
pci_conf_write(ph->ph_pc, ph->ph_tag, VIPER_CFG_PIRQ, reg);
return (0);
}