git.joshuawise.com / netwatch.git / blame
| Commit | Line | Data |
|---|---|---|
| 85bc8ca6 JW |
1 | #include <smi.h> |
| 2 | #include <pci.h> | |
| 3 | #include <io.h> | |
| 4 | #include <stdint.h> | |
| 4fb81ad0 | 5 | #include <vga-overlay.h> |
| cc80dccf | 6 | #include <reg-82801b.h> |
| 85bc8ca6 | 7 | |
| 9cfcd0ca | 8 | static uint16_t _get_PMBASE() |
| 85bc8ca6 | 9 | { |
| cc80dccf | 10 | return pci_read32(ICH2_LPC_BUS, ICH2_LPC_DEV, ICH2_LPC_FN, ICH2_LPC_PCI_PMBASE) & ICH2_PMBASE_MASK; |
| 85bc8ca6 JW |
11 | } |
| 12 | ||
| 13 | void smi_disable() | |
| 14 | { | |
| cc80dccf JW |
15 | unsigned short smi_en = _get_PMBASE() + ICH2_PMBASE_SMI_EN; |
| 16 | outl(smi_en, inl(smi_en) & ~ICH2_SMI_EN_GBL_SMI_EN); | |
| 85bc8ca6 JW |
17 | } |
| 18 | ||
| 19 | void smi_enable() | |
| 20 | { | |
| cc80dccf JW |
21 | unsigned short smi_en = _get_PMBASE() + ICH2_PMBASE_SMI_EN; |
| 22 | outl(smi_en, inl(smi_en) | ICH2_SMI_EN_GBL_SMI_EN); | |
| 85bc8ca6 JW |
23 | } |
| 24 | ||
| 25 | unsigned long smi_status() | |
| 26 | { | |
| cc80dccf | 27 | unsigned short smi_sts = _get_PMBASE() + ICH2_PMBASE_SMI_STS; |
| 85bc8ca6 JW |
28 | return inl(smi_sts); |
| 29 | } | |
| d71d9872 | 30 | |
| 4fb81ad0 JW |
31 | void smi_poll() |
| 32 | { | |
| 33 | unsigned long sts = smi_status(); | |
| 34 | ||
| 35 | if (sts & ICH2_SMI_STS_BIOS_STS) | |
| 36 | { | |
| 37 | dolog("Unhandled: BIOS_STS"); | |
| 38 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_BIOS_STS); | |
| 39 | } | |
| 40 | ||
| 41 | if (sts & ICH2_SMI_STS_LEGACY_USB_STS) | |
| 42 | { | |
| 43 | dolog("Unhandled: LEGACY_USB_STS"); | |
| 44 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_LEGACY_USB_STS); | |
| 45 | } | |
| 46 | ||
| 47 | if (sts & ICH2_SMI_STS_SLP_SMI_STS) | |
| 48 | { | |
| 49 | dolog("Unhandled: SLP_SMI_STS"); | |
| 50 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SLP_SMI_STS); | |
| 51 | } | |
| 52 | ||
| 53 | if (sts & ICH2_SMI_STS_APM_STS) | |
| 54 | { | |
| 55 | dolog("Unhandled: APM_STS"); | |
| 56 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SLP_SMI_STS); | |
| 57 | } | |
| 58 | ||
| 59 | if (sts & ICH2_SMI_STS_SWSMI_TMR_STS) // Ack it, then request another. | |
| 60 | { | |
| 61 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SLP_SMI_STS); | |
| 62 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN, | |
| 63 | inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) & ~ICH2_SMI_EN_SWSMI_TMR_EN); | |
| 64 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN, | |
| 65 | inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) | ICH2_SMI_EN_SWSMI_TMR_EN); | |
| 66 | } | |
| 67 | ||
| 68 | if (sts & ICH2_SMI_STS_PM1_STS_REG) | |
| 69 | { | |
| 70 | /* XXX -- trawl through PMBASE+00h to see what happened */ | |
| 71 | } | |
| 72 | ||
| 73 | if (sts & ICH2_SMI_STS_GPE0_STS) | |
| 74 | { | |
| 75 | /* XXX -- trawl through GPE0_STS to see what happened */ | |
| 76 | } | |
| 77 | ||
| 78 | if (sts & ICH2_SMI_STS_MCSMI_STS) | |
| 79 | { | |
| 80 | dolog("Unhandled: MCSMI_STS"); | |
| 81 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_MCSMI_STS); | |
| 82 | } | |
| 83 | ||
| 84 | if (sts & ICH2_SMI_STS_DEVMON_STS) | |
| 85 | { | |
| 86 | /* XXX -- trawl through DEVx_TRAP_STS to see what happened */ | |
| 87 | /* XXX -- trawl through DEVTRAP_STS to see what happened */ | |
| 88 | } | |
| 89 | ||
| 90 | if (sts & ICH2_SMI_STS_TCO_STS) | |
| 91 | { | |
| 92 | dolog("Unhandled: TCO_STS"); | |
| 93 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_TCO_STS); | |
| 94 | } | |
| 95 | ||
| 96 | if (sts & ICH2_SMI_STS_PERIODIC_STS) | |
| 97 | { | |
| 98 | dolog("Unhandled: PERIODIC_STS"); | |
| 99 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_PERIODIC_STS); | |
| 100 | } | |
| 101 | ||
| 102 | if (sts & ICH2_SMI_STS_SERIRQ_SMI_STS) | |
| 103 | { | |
| 104 | dolog("Unhandled: SERIRQ_SMI_STS"); | |
| 105 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SERIRQ_SMI_STS); | |
| 106 | } | |
| 107 | ||
| 108 | if (sts & ICH2_SMI_STS_SMBUS_SMI_STS) | |
| 109 | { | |
| 110 | dolog("Unhandled: SMBUS_SMI_STS"); | |
| 111 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_STS, ICH2_SMI_STS_SMBUS_SMI_STS); | |
| 112 | } | |
| 113 | ||
| 114 | if (smi_status()) | |
| 115 | dolog("WARNING: failed to clear SMI_STS!"); | |
| 116 | ||
| 117 | outl(_get_PMBASE() + ICH2_PMBASE_SMI_EN, | |
| 118 | inl(_get_PMBASE() + ICH2_PMBASE_SMI_EN) | | |
| 119 | ICH2_SMI_EN_EOS | | |
| 120 | ICH2_SMI_EN_GBL_SMI_EN); | |
| 121 | } |