#include <pci.h>
#include <io.h>
#include <stdint.h>
+#include <vga-overlay.h>
+#include <reg-82801b.h>
+#include <output.h>
-uint16_t _get_PMBASE()
+static uint16_t _get_PMBASE()
{
- return pci_read32(0, 21, 0, 0x40) & 0xFF80;
+ static long pmbase = -1;
+
+ if (pmbase == -1) /* Memoize it so that we don't have to hit PCI so often. */
+ pmbase = pci_read32(ICH2_LPC_BUS, ICH2_LPC_DEV, ICH2_LPC_FN, ICH2_LPC_PCI_PMBASE) & ICH2_PMBASE_MASK;
+
+ return pmbase;
}
void smi_disable()
{
- unsigned short smi_en = _get_PMBASE() + 0x30;
- outl(smi_en, inl(smi_en) & ~0x0001);
+ unsigned short smi_en = _get_PMBASE() + ICH2_PMBASE_SMI_EN;
+ outl(smi_en, inl(smi_en) & ~ICH2_SMI_EN_GBL_SMI_EN);
}
void smi_enable()
{
- unsigned short smi_en = _get_PMBASE() + 0x30;
- outl(smi_en, inl(smi_en) | 0x0001);
+ unsigned short smi_en = _get_PMBASE() + ICH2_PMBASE_SMI_EN;
+ outl(smi_en, inl(smi_en) | ICH2_SMI_EN_GBL_SMI_EN);
}
unsigned long smi_status()
{
- unsigned short smi_sts = _get_PMBASE() + 0x34;
+ unsigned short smi_sts = _get_PMBASE() + ICH2_PMBASE_SMI_STS;
return inl(smi_sts);
}
+
+void smi_poll()
+{
+ unsigned long sts = smi_status();
+
+ if (sts & ICH2_SMI_STS_BIOS_STS)
+ {
+ output("Unhandled: BIOS_STS");
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_BIOS_STS);
+ }
+
+ if (sts & ICH2_SMI_STS_LEGACY_USB_STS)
+ {
+ output("Unhandled: LEGACY_USB_STS");
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_LEGACY_USB_STS);
+ }
+
+ if (sts & ICH2_SMI_STS_SLP_SMI_STS)
+ {
+ output("Unhandled: SLP_SMI_STS");
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SLP_SMI_STS);
+ }
+
+ if (sts & ICH2_SMI_STS_APM_STS)
+ {
+ output("Unhandled: APM_STS");
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_APM_STS);
+ }
+
+ if (sts & ICH2_SMI_STS_SWSMI_TMR_STS) // Ack it, then request another.
+ {
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SWSMI_TMR_STS);
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN,
+ inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) & ~ICH2_SMI_EN_SWSMI_TMR_EN);
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN,
+ inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) | ICH2_SMI_EN_SWSMI_TMR_EN);
+ }
+
+ if (sts & ICH2_SMI_STS_PM1_STS_REG)
+ {
+ unsigned short pm1_sts = inw(_get_PMBASE() + ICH2_PMBASE_PM1_STS);
+ unsigned short pm1_en = inw(_get_PMBASE() + ICH2_PMBASE_PM1_EN);
+
+ pm1_sts &= pm1_en;
+ if (pm1_sts & ICH2_PM1_STS_RTC_STS)
+ {
+ output("Unhandled: PM1_STS: RTC_STS");
+ outw(_get_PMBASE() + ICH2_PMBASE_PM1_STS, ICH2_PM1_STS_RTC_STS);
+ }
+
+ if (pm1_sts & ICH2_PM1_STS_PWRBTN_STS)
+ {
+ output("Unhandled: PM1_STS: PWRBTN_STS");
+ outw(_get_PMBASE() + ICH2_PMBASE_PM1_STS, ICH2_PM1_STS_PWRBTN_STS);
+ }
+
+ if (pm1_sts & ICH2_PM1_STS_GBL_STS)
+ {
+ output("Unhandled: PM1_STS: GBL_STS");
+ outw(_get_PMBASE() + ICH2_PMBASE_PM1_STS, ICH2_PM1_STS_GBL_STS);
+ }
+
+ if (pm1_sts & ICH2_PM1_STS_TMROF_STS)
+ {
+ output("Unhandled: PM1_STS: TMROF_STS");
+ outw(_get_PMBASE() + ICH2_PMBASE_PM1_STS, ICH2_PM1_STS_TMROF_STS);
+ }
+
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_PM1_STS_REG);
+ }
+
+ if (sts & ICH2_SMI_STS_GPE0_STS)
+ {
+ /* XXX -- trawl through GPE0_STS to see what happened */
+ output("XXX Unhandled: GPE0_STS (expect lockup)");
+ }
+
+ if (sts & ICH2_SMI_STS_GPE1_STS)
+ {
+ /* XXX -- trawl through GPE1_STS to see what happened */
+ output("XXX Unhandled: GPE1_STS (expect lockup)");
+ }
+
+ if (sts & ICH2_SMI_STS_MCSMI_STS)
+ {
+ output("Unhandled: MCSMI_STS");
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_MCSMI_STS);
+ }
+
+ if (sts & ICH2_SMI_STS_DEVMON_STS)
+ {
+ unsigned short mon_smi = inw(_get_PMBASE() + ICH2_PMBASE_MON_SMI);
+ unsigned long devact_sts = inl(_get_PMBASE() + ICH2_PMBASE_DEVACT_STS);
+ unsigned long devtrap_en = inl(_get_PMBASE() + ICH2_PMBASE_DEVTRAP_EN);
+ if (((mon_smi & 0x0F00) >> 8) & ((mon_smi & 0xF000) >> 12))
+ outputf("Unhandled: MON_SMI (%04x)", mon_smi);
+ if (devact_sts & devtrap_en)
+ outputf("Unhandled: DEVTRAP (%08x)", devact_sts & devtrap_en);
+ }
+
+ if (sts & ICH2_SMI_STS_TCO_STS)
+ {
+ output("Unhandled: TCO_STS");
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_TCO_STS);
+ }
+
+ if (sts & ICH2_SMI_STS_PERIODIC_STS)
+ {
+ output("Unhandled: PERIODIC_STS");
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_PERIODIC_STS);
+ }
+
+ if (sts & ICH2_SMI_STS_SERIRQ_SMI_STS)
+ {
+ output("Unhandled: SERIRQ_SMI_STS");
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SERIRQ_SMI_STS);
+ }
+
+ if (sts & ICH2_SMI_STS_SMBUS_SMI_STS)
+ {
+ output("Unhandled: SMBUS_SMI_STS");
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SMBUS_SMI_STS);
+ }
+
+ if (smi_status() & ~ICH2_SMI_STS_PM1_STS_REG) /* Either the chipset is buggy, or we are. */
+ outputf("WARN: couldn't clear SMI_STS! (%08x)", smi_status());
+
+ outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN,
+ inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) |
+ ICH2_SMI_EN_EOS |
+ ICH2_SMI_EN_GBL_SMI_EN);
+}