#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/opti82c700reg.h>
#ifdef FIRESTARDEBUG
#define DPRINTF(arg) printf arg
#else
#define DPRINTF(arg)
#endif
int opti82c700_getclink(pciintr_icu_handle_t, int, int *);
int opti82c700_get_intr(pciintr_icu_handle_t, int, int *);
int opti82c700_set_intr(pciintr_icu_handle_t, int, int);
int opti82c700_get_trigger(pciintr_icu_handle_t, int, int *);
int opti82c700_set_trigger(pciintr_icu_handle_t, int, int);
const struct pciintr_icu opti82c700_pci_icu = {
opti82c700_getclink,
opti82c700_get_intr,
opti82c700_set_intr,
opti82c700_get_trigger,
opti82c700_set_trigger,
};
struct opti82c700_handle {
pci_chipset_tag_t ph_pc;
pcitag_t ph_tag;
};
int opti82c700_addr(int, int *, int *);
#ifdef FIRESTARDEBUG
void opti82c700_pir_dump(struct opti82c700_handle *);
#endif
int
opti82c700_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 opti82c700_handle *ph;
ph = malloc(sizeof(*ph), M_DEVBUF, M_NOWAIT);
if (ph == NULL)
return (1);
ph->ph_pc = pc;
ph->ph_tag = tag;
#ifdef FIRESTARDEBUG
opti82c700_pir_dump(ph);
#endif
*ptagp = &opti82c700_pci_icu;
*phandp = ph;
return (0);
}
int
opti82c700_addr(int link, int *addrofs, int *ofs)
{
int regofs, src;
regofs = FIRESTAR_PIR_REGOFS(link);
src = FIRESTAR_PIR_SELECTSRC(link);
switch (src) {
case FIRESTAR_PIR_SELECT_NONE:
return (1);
case FIRESTAR_PIR_SELECT_IRQ:
if (regofs < 0 || regofs > 7)
return (1);
*addrofs = FIRESTAR_CFG_INTR_IRQ + (regofs >> 2);
*ofs = (regofs & 3) << 3;
break;
case FIRESTAR_PIR_SELECT_PIRQ:
case FIRESTAR_PIR_SELECT_BRIDGE:
if (regofs < 0 || regofs > 3)
return (1);
*addrofs = FIRESTAR_CFG_INTR_PIRQ;
*ofs = regofs << 2;
break;
default:
return (1);
}
return (0);
}
int
opti82c700_getclink(pciintr_icu_handle_t v, int link, int *clinkp)
{
DPRINTF(("FireStar link value 0x%x: ", link));
switch (FIRESTAR_PIR_SELECTSRC(link)) {
default:
DPRINTF(("bogus IRQ selection source\n"));
return (1);
case FIRESTAR_PIR_SELECT_NONE:
DPRINTF(("No interrupt connection\n"));
return (1);
case FIRESTAR_PIR_SELECT_IRQ:
DPRINTF(("FireStar IRQ pin"));
break;
case FIRESTAR_PIR_SELECT_PIRQ:
DPRINTF(("FireStar PIO pin or Serial IRQ PIRQ#"));
break;
case FIRESTAR_PIR_SELECT_BRIDGE:
DPRINTF(("FireBridge 1 INTx# pin"));
break;
}
DPRINTF((" REGOFST:%#x\n", FIRESTAR_PIR_REGOFS(link)));
*clinkp = link;
return (0);
}
int
opti82c700_get_intr(pciintr_icu_handle_t v, int clink, int *irqp)
{
struct opti82c700_handle *ph = v;
pcireg_t reg;
int val, addrofs, ofs;
if (opti82c700_addr(clink, &addrofs, &ofs))
return (1);
reg = pci_conf_read(ph->ph_pc, ph->ph_tag, addrofs);
val = (reg >> ofs) & FIRESTAR_CFG_PIRQ_MASK;
*irqp = (val == FIRESTAR_PIRQ_NONE) ?
I386_PCI_INTERRUPT_LINE_NO_CONNECTION : val;
return (0);
}
int
opti82c700_set_intr(pciintr_icu_handle_t v, int clink, int irq)
{
struct opti82c700_handle *ph = v;
int addrofs, ofs;
pcireg_t reg;
if (FIRESTAR_LEGAL_IRQ(irq) == 0)
return (1);
if (opti82c700_addr(clink, &addrofs, &ofs))
return (1);
reg = pci_conf_read(ph->ph_pc, ph->ph_tag, addrofs);
reg &= ~(FIRESTAR_CFG_PIRQ_MASK << ofs);
reg |= (irq << ofs);
pci_conf_write(ph->ph_pc, ph->ph_tag, addrofs, reg);
return (0);
}
int
opti82c700_get_trigger(pciintr_icu_handle_t v, int irq, int *triggerp)
{
struct opti82c700_handle *ph = v;
int i, val, addrofs, ofs;
pcireg_t reg;
if (FIRESTAR_LEGAL_IRQ(irq) == 0) {
*triggerp = IST_EDGE;
return (0);
}
for (i = 0; i < 8; i++) {
opti82c700_addr(FIRESTAR_PIR_MAKELINK(FIRESTAR_PIR_SELECT_IRQ,
i), &addrofs, &ofs);
reg = pci_conf_read(ph->ph_pc, ph->ph_tag, addrofs);
val = (reg >> ofs) & FIRESTAR_CFG_PIRQ_MASK;
if (val != irq)
continue;
val = ((reg >> ofs) >> FIRESTAR_TRIGGER_SHIFT) &
FIRESTAR_TRIGGER_MASK;
*triggerp = val ? IST_LEVEL : IST_EDGE;
return (0);
}
for (i = 0; i < 4; i++) {
opti82c700_addr(FIRESTAR_PIR_MAKELINK(FIRESTAR_PIR_SELECT_PIRQ,
i), &addrofs, &ofs);
reg = pci_conf_read(ph->ph_pc, ph->ph_tag, addrofs);
val = (reg >> ofs) & FIRESTAR_CFG_PIRQ_MASK;
if (val != irq)
continue;
*triggerp = IST_LEVEL;
return (0);
}
return (1);
}
int
opti82c700_set_trigger(pciintr_icu_handle_t v, int irq, int trigger)
{
struct opti82c700_handle *ph = v;
int i, val, addrofs, ofs;
pcireg_t reg;
if (FIRESTAR_LEGAL_IRQ(irq) == 0) {
return ((trigger != IST_LEVEL) ? 0 : 1);
}
for (i = 0; i < 8; i++) {
opti82c700_addr(FIRESTAR_PIR_MAKELINK(FIRESTAR_PIR_SELECT_IRQ,
i), &addrofs, &ofs);
reg = pci_conf_read(ph->ph_pc, ph->ph_tag, addrofs);
val = (reg >> ofs) & FIRESTAR_CFG_PIRQ_MASK;
if (val != irq)
continue;
if (trigger == IST_LEVEL)
reg |= (FIRESTAR_TRIGGER_MASK <<
(FIRESTAR_TRIGGER_SHIFT + ofs));
else
reg &= ~(FIRESTAR_TRIGGER_MASK <<
(FIRESTAR_TRIGGER_SHIFT + ofs));
pci_conf_write(ph->ph_pc, ph->ph_tag, addrofs, reg);
return (0);
}
for (i = 0; i < 4; i++) {
opti82c700_addr(FIRESTAR_PIR_MAKELINK(FIRESTAR_PIR_SELECT_PIRQ,
i), &addrofs, &ofs);
reg = pci_conf_read(ph->ph_pc, ph->ph_tag, addrofs);
val = (reg >> ofs) & FIRESTAR_CFG_PIRQ_MASK;
if (val != irq)
continue;
return (trigger == IST_LEVEL ? 0 : 1);
}
return (1);
}