src/southbridge/intel/i82801gx/i82801gx_smihandler.c

   1 /*
   2  * This file is part of the coreboot project.
   3  *
   4  * Copyright (C) 2008-2009 coresystems GmbH
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License as
   8  * published by the Free Software Foundation; version 2 of
   9  * the License.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,
  19  * MA 02110-1301 USA
  20  */
  21
  22 #include <types.h>
  23 #include <arch/io.h>
  24 #include <arch/romcc_io.h>
  25 #include <console/console.h>
  26 #include <cpu/x86/cache.h>
  27 #include <cpu/x86/smm.h>
  28 #include <device/pci_def.h>
  29 #include "i82801gx.h"
  30
  31 #define APM_CNT         0xb2
  32 #define   CST_CONTROL   0x85
  33 #define   PST_CONTROL   0x80
  34 #define   ACPI_DISABLE  0x1e
  35 #define   ACPI_ENABLE   0xe1
  36 #define   GNVS_UPDATE   0xea
  37 #define APM_STS         0xb3
  38
  39 /* I945 */
  40 #define SMRAM           0x9d
  41 #define   D_OPEN        (1 << 6)
  42 #define   D_CLS         (1 << 5)
  43 #define   D_LCK         (1 << 4)
  44 #define   G_SMRANE      (1 << 3)
  45 #define   C_BASE_SEG    ((0 << 2) | (1 << 1) | (0 << 0))
  46
  47 #include "i82801gx_nvs.h"
  48
  49 /* While we read PMBASE dynamically in case it changed, let's
  50  * initialize it with a sane value
  51  */
  52 u16 pmbase = DEFAULT_PMBASE;
  53 u8 smm_initialized = 0;
  54
  55 /* GNVS needs to be updated by an 0xEA PM Trap (B2) after it has been located
  56  * by coreboot.
  57  */
  58 global_nvs_t *gnvs = (global_nvs_t *)0x0;
  59 void *tcg = (void *)0x0;
  60 void *smi1 = (void *)0x0;
  61
  62 /**
  63  * @brief read and clear PM1_STS
  64  * @return PM1_STS register
  65  */
  66 static u16 reset_pm1_status(void)
  67 {
  68         u16 reg16;
  69
  70         reg16 = inw(pmbase + PM1_STS);
  71         /* set status bits are cleared by writing 1 to them */
  72         outw(reg16, pmbase + PM1_STS);
  73
  74         return reg16;
  75 }
  76
  77 static void dump_pm1_status(u16 pm1_sts)
  78 {
  79         printk_spew("PM1_STS: ");
  80         if (pm1_sts & (1 << 15)) printk_spew("WAK ");
  81         if (pm1_sts & (1 << 14)) printk_spew("PCIEXPWAK ");
  82         if (pm1_sts & (1 << 11)) printk_spew("PRBTNOR ");
  83         if (pm1_sts & (1 << 10)) printk_spew("RTC ");
  84         if (pm1_sts & (1 <<  8)) printk_spew("PWRBTN ");
  85         if (pm1_sts & (1 <<  5)) printk_spew("GBL ");
  86         if (pm1_sts & (1 <<  4)) printk_spew("BM ");
  87         if (pm1_sts & (1 <<  0)) printk_spew("TMROF ");
  88         printk_spew("\n");
  89         int reg16 = inw(pmbase + PM1_EN);
  90         printk_spew("PM1_EN: %x\n", reg16);
  91 }
  92
  93 /**
  94  * @brief read and clear SMI_STS
  95  * @return SMI_STS register
  96  */
  97 static u32 reset_smi_status(void)
  98 {
  99         u32 reg32;
 100
 101         reg32 = inl(pmbase + SMI_STS);
 102         /* set status bits are cleared by writing 1 to them */
 103         outl(reg32, pmbase + SMI_STS);
 104
 105         return reg32;
 106 }
 107
 108 static void dump_smi_status(u32 smi_sts)
 109 {
 110         printk_debug("SMI_STS: ");
 111         if (smi_sts & (1 << 26)) printk_debug("SPI ");
 112         if (smi_sts & (1 << 25)) printk_debug("EL_SMI ");
 113         if (smi_sts & (1 << 21)) printk_debug("MONITOR ");
 114         if (smi_sts & (1 << 20)) printk_debug("PCI_EXP_SMI ");
 115         if (smi_sts & (1 << 18)) printk_debug("INTEL_USB2 ");
 116         if (smi_sts & (1 << 17)) printk_debug("LEGACY_USB2 ");
 117         if (smi_sts & (1 << 16)) printk_debug("SMBUS_SMI ");
 118         if (smi_sts & (1 << 15)) printk_debug("SERIRQ_SMI ");
 119         if (smi_sts & (1 << 14)) printk_debug("PERIODIC ");
 120         if (smi_sts & (1 << 13)) printk_debug("TCO ");
 121         if (smi_sts & (1 << 12)) printk_debug("DEVMON ");
 122         if (smi_sts & (1 << 11)) printk_debug("MCSMI ");
 123         if (smi_sts & (1 << 10)) printk_debug("GPI ");
 124         if (smi_sts & (1 <<  9)) printk_debug("GPE0 ");
 125         if (smi_sts & (1 <<  8)) printk_debug("PM1 ");
 126         if (smi_sts & (1 <<  6)) printk_debug("SWSMI_TMR ");
 127         if (smi_sts & (1 <<  5)) printk_debug("APM ");
 128         if (smi_sts & (1 <<  4)) printk_debug("SLP_SMI ");
 129         if (smi_sts & (1 <<  3)) printk_debug("LEGACY_USB ");
 130         if (smi_sts & (1 <<  2)) printk_debug("BIOS ");
 131         printk_debug("\n");
 132 }
 133
 134
 135 /**
 136  * @brief read and clear GPE0_STS
 137  * @return GPE0_STS register
 138  */
 139 static u32 reset_gpe0_status(void)
 140 {
 141         u32 reg32;
 142
 143         reg32 = inl(pmbase + GPE0_STS);
 144         /* set status bits are cleared by writing 1 to them */
 145         outl(reg32, pmbase + GPE0_STS);
 146
 147         return reg32;
 148 }
 149
 150 static void dump_gpe0_status(u32 gpe0_sts)
 151 {
 152         int i;
 153         printk_debug("GPE0_STS: ");
 154         for (i=31; i<= 16; i--) {
 155                 if (gpe0_sts & (1 << i)) printk_debug("GPIO%d ", (i-16));
 156         }
 157         if (gpe0_sts & (1 << 14)) printk_debug("USB4 ");
 158         if (gpe0_sts & (1 << 13)) printk_debug("PME_B0 ");
 159         if (gpe0_sts & (1 << 12)) printk_debug("USB3 ");
 160         if (gpe0_sts & (1 << 11)) printk_debug("PME ");
 161         if (gpe0_sts & (1 << 10)) printk_debug("EL_SCI/BATLOW ");
 162         if (gpe0_sts & (1 <<  9)) printk_debug("PCI_EXP ");
 163         if (gpe0_sts & (1 <<  8)) printk_debug("RI ");
 164         if (gpe0_sts & (1 <<  7)) printk_debug("SMB_WAK ");
 165         if (gpe0_sts & (1 <<  6)) printk_debug("TCO_SCI ");
 166         if (gpe0_sts & (1 <<  5)) printk_debug("AC97 ");
 167         if (gpe0_sts & (1 <<  4)) printk_debug("USB2 ");
 168         if (gpe0_sts & (1 <<  3)) printk_debug("USB1 ");
 169         if (gpe0_sts & (1 <<  2)) printk_debug("HOT_PLUG ");
 170         if (gpe0_sts & (1 <<  0)) printk_debug("THRM ");
 171         printk_debug("\n");
 172 }
 173
 174
 175 /**
 176  * @brief read and clear TCOx_STS
 177  * @return TCOx_STS registers
 178  */
 179 static u32 reset_tco_status(void)
 180 {
 181         u32 tcobase = pmbase + 0x60;
 182         u32 reg32;
 183
 184         reg32 = inl(tcobase + 0x04);
 185         /* set status bits are cleared by writing 1 to them */
 186         outl(reg32 & ~(1<<18), tcobase + 0x04); //  Don't clear BOOT_STS before SECOND_TO_STS
 187         if (reg32 & (1 << 18))
 188                 outl(reg32 & (1<<18), tcobase + 0x04); // clear BOOT_STS
 189
 190         return reg32;
 191 }
 192
 193
 194 static void dump_tco_status(u32 tco_sts)
 195 {
 196         printk_debug("TCO_STS: ");
 197         if (tco_sts & (1 << 20)) printk_debug("SMLINK_SLV ");
 198         if (tco_sts & (1 << 18)) printk_debug("BOOT ");
 199         if (tco_sts & (1 << 17)) printk_debug("SECOND_TO ");
 200         if (tco_sts & (1 << 16)) printk_debug("INTRD_DET ");
 201         if (tco_sts & (1 << 12)) printk_debug("DMISERR ");
 202         if (tco_sts & (1 << 10)) printk_debug("DMISMI ");
 203         if (tco_sts & (1 <<  9)) printk_debug("DMISCI ");
 204         if (tco_sts & (1 <<  8)) printk_debug("BIOSWR ");
 205         if (tco_sts & (1 <<  7)) printk_debug("NEWCENTURY ");
 206         if (tco_sts & (1 <<  3)) printk_debug("TIMEOUT ");
 207         if (tco_sts & (1 <<  2)) printk_debug("TCO_INT ");
 208         if (tco_sts & (1 <<  1)) printk_debug("SW_TCO ");
 209         if (tco_sts & (1 <<  0)) printk_debug("NMI2SMI ");
 210         printk_debug("\n");
 211 }
 212
 213 /* We are using PCIe accesses for now
 214  *  1. the chipset can do it
 215  *  2. we don't need to worry about how we leave 0xcf8/0xcfc behind
 216  */
 217 #include "../../../northbridge/intel/i945/pcie_config.c"
 218
 219 int southbridge_io_trap_handler(int smif)
 220 {
 221         switch (smif) {
 222         case 0x32:
 223                 printk_debug("OS Init\n");
 224                 /* gnvs->smif:
 225                  *  On success, the IO Trap Handler returns 0
 226                  *  On failure, the IO Trap Handler returns a value != 0
 227                  */
 228                 gnvs->smif = 0;
 229                 return 1; /* IO trap handled */
 230         }
 231
 232         /* Not handled */
 233         return 0;
 234 }
 235
 236 /**
 237  * @brief Set the EOS bit
 238  */
 239 void southbridge_smi_set_eos(void)
 240 {
 241         u8 reg8;
 242
 243         reg8 = inb(pmbase + SMI_EN);
 244         reg8 |= EOS;
 245         outb(reg8, pmbase + SMI_EN);
 246 }
 247
 248 static void busmaster_disable_on_bus(int bus)
 249 {
 250         int slot, func;
 251         unsigned int val;
 252         unsigned char hdr;
 253
 254         for (slot = 0; slot < 0x20; slot++) {
 255                 for (func = 0; func < 8; func++) {
 256                         u32 reg32;
 257                         device_t dev = PCI_DEV(bus, slot, func);
 258
 259                         val = pci_read_config32(dev, PCI_VENDOR_ID);
 260
 261                         if (val == 0xffffffff || val == 0x00000000 ||
 262                             val == 0x0000ffff || val == 0xffff0000)
 263                                 continue;
 264
 265                         /* Disable Bus Mastering for this one device */
 266                         reg32 = pci_read_config32(dev, PCI_COMMAND);
 267                         reg32 &= ~PCI_COMMAND_MASTER;
 268                         pci_write_config32(dev, PCI_COMMAND, reg32);
 269
 270                         /* If this is a bridge, then follow it. */
 271                         hdr = pci_read_config8(dev, PCI_HEADER_TYPE);
 272                         hdr &= 0x7f;
 273                         if (hdr == PCI_HEADER_TYPE_BRIDGE ||
 274                             hdr == PCI_HEADER_TYPE_CARDBUS) {
 275                                 unsigned int buses;
 276                                 buses = pci_read_config32(dev, PCI_PRIMARY_BUS);
 277                                 busmaster_disable_on_bus((buses >> 8) & 0xff);
 278                         }
 279                 }
 280         }
 281 }
 282
 283
 284 static void southbridge_smi_sleep(unsigned int node, smm_state_save_area_t *state_save)
 285 {
 286         u8 reg8;
 287         u32 reg32;
 288         u8 slp_typ;
 289         /* FIXME: the power state on boot should be read from
 290          * CMOS or even better from GNVS. Right now it's hard
 291          * coded at compile time.
 292          */
 293         u8 s5pwr = CONFIG_MAINBOARD_POWER_ON_AFTER_POWER_FAIL;
 294
 295         /* First, disable further SMIs */
 296         reg8 = inb(pmbase + SMI_EN);
 297         reg8 &= ~SLP_SMI_EN;
 298         outb(reg8, pmbase + SMI_EN);
 299
 300         /* Figure out SLP_TYP */
 301         reg32 = inl(pmbase + PM1_CNT);
 302         printk_spew("SMI#: SLP = 0x%08x\n", reg32);
 303         slp_typ = (reg32 >> 10) & 7;
 304
 305         /* Next, do the deed.
 306          */
 307
 308         switch (slp_typ) {
 309         case 0: printk_debug("SMI#: Entering S0 (On)\n"); break;
 310         case 1: printk_debug("SMI#: Entering S1 (Assert STPCLK#)\n"); break;
 311         case 5:
 312                 printk_debug("SMI#: Entering S3 (Suspend-To-RAM)\n");
 313                 /* Invalidate the cache before going to S3 */
 314                 wbinvd();
 315                 break;
 316         case 6: printk_debug("SMI#: Entering S4 (Suspend-To-Disk)\n"); break;
 317         case 7:
 318                 printk_debug("SMI#: Entering S5 (Soft Power off)\n");
 319
 320                 outl(0, pmbase + GPE0_EN);
 321
 322                 /* Should we keep the power state after a power loss?
 323                  * In case the setting is "ON" or "OFF" we don't have
 324                  * to do anything. But if it's "KEEP" we have to switch
 325                  * to "OFF" before entering S5.
 326                  */
 327                 if (s5pwr == MAINBOARD_POWER_KEEP) {
 328                         reg8 = pcie_read_config8(PCI_DEV(0, 0x1f, 0), GEN_PMCON_3);
 329                         reg8 |= 1;
 330                         pcie_write_config8(PCI_DEV(0, 0x1f, 0), GEN_PMCON_3, reg8);
 331                 }
 332
 333                 /* also iterates over all bridges on bus 0 */
 334                 busmaster_disable_on_bus(0);
 335                 break;
 336         default: printk_debug("SMI#: ERROR: SLP_TYP reserved\n"); break;
 337         }
 338
 339         /* Write back to the SLP register to cause the originally intended
 340          * event again. We need to set BIT13 (SLP_EN) though to make the
 341          * sleep happen.
 342          */
 343         outl(reg32 | SLP_EN, pmbase + PM1_CNT);
 344
 345         /* In most sleep states, the code flow of this function ends at
 346          * the line above. However, if we entered sleep state S1 and wake
 347          * up again, we will continue to execute code in this function.
 348          */
 349         reg32 = inl(pmbase + PM1_CNT);
 350         if (reg32 & SCI_EN) {
 351                 /* The OS is not an ACPI OS, so we set the state to S0 */
 352                 reg32 &= ~(SLP_EN | SLP_TYP);
 353                 outl(reg32, pmbase + PM1_CNT);
 354         }
 355 }
 356
 357 static void southbridge_smi_apmc(unsigned int node, smm_state_save_area_t *state_save)
 358 {
 359         u32 pmctrl;
 360         u8 reg8;
 361
 362         /* Emulate B2 register as the FADT / Linux expects it */
 363
 364         reg8 = inb(APM_CNT);
 365         switch (reg8) {
 366         case CST_CONTROL:
 367                 /* Calling this function seems to cause
 368                  * some kind of race condition in Linux
 369                  * and causes a kernel oops
 370                  */
 371                 printk_debug("C-state control\n");
 372                 break;
 373         case PST_CONTROL:
 374                 /* Calling this function seems to cause
 375                  * some kind of race condition in Linux
 376                  * and causes a kernel oops
 377                  */
 378                 printk_debug("P-state control\n");
 379                 break;
 380         case ACPI_DISABLE:
 381                 pmctrl = inl(pmbase + PM1_CNT);
 382                 pmctrl &= ~SCI_EN;
 383                 outl(pmctrl, pmbase + PM1_CNT);
 384                 printk_debug("SMI#: ACPI disabled.\n");
 385                 break;
 386         case ACPI_ENABLE:
 387                 pmctrl = inl(pmbase + PM1_CNT);
 388                 pmctrl |= SCI_EN;
 389                 outl(pmctrl, pmbase + PM1_CNT);
 390                 printk_debug("SMI#: ACPI enabled.\n");
 391                 break;
 392         case GNVS_UPDATE:
 393                 if (smm_initialized) {
 394                         printk_debug("SMI#: SMM structures already initialized!\n");
 395                         return;
 396                 }
 397                 gnvs = *(global_nvs_t **)0x500;
 398                 tcg  = *(void **)0x504;
 399                 smi1 = *(void **)0x508;
 400                 smm_initialized = 1;
 401                 printk_debug("SMI#: Setting up structures to %p, %p, %p\n", gnvs, tcg, smi1);
 402                 break;
 403         default:
 404                 printk_debug("SMI#: Unknown function APM_CNT=%02x\n", reg8);
 405         }
 406 }
 407
 408 static void southbridge_smi_pm1(unsigned int node, smm_state_save_area_t *state_save)
 409 {
 410         u16 pm1_sts;
 411
 412         pm1_sts = reset_pm1_status();
 413         dump_pm1_status(pm1_sts);
 414
 415         /* While OSPM is not active, poweroff immediately
 416          * on a power button event.
 417          */
 418         if (pm1_sts & PWRBTN_STS) {
 419                 // power button pressed
 420                 u32 reg32;
 421                 reg32 = (7 << 10) | (1 << 13);
 422                 outl(reg32, pmbase + PM1_CNT);
 423         }
 424 }
 425
 426 static void southbridge_smi_gpe0(unsigned int node, smm_state_save_area_t *state_save)
 427 {
 428         u32 gpe0_sts;
 429
 430         gpe0_sts = reset_gpe0_status();
 431         dump_gpe0_status(gpe0_sts);
 432 }
 433
 434 void __attribute__((weak)) mainboard_smi_gpi(u16 gpi_sts);
 435
 436 static void southbridge_smi_gpi(unsigned int node, smm_state_save_area_t *state_save)
 437 {
 438         u16 reg16;
 439         reg16 = inw(pmbase + ALT_GP_SMI_STS);
 440         outl(reg16, pmbase + ALT_GP_SMI_STS);
 441
 442         reg16 &= inw(pmbase + ALT_GP_SMI_EN);
 443
 444         if (mainboard_smi_gpi) {
 445                 mainboard_smi_gpi(reg16);
 446         } else {
 447                 if (reg16)
 448                         printk_debug("GPI (mask %04x)\n",reg16);
 449         }
 450 }
 451
 452 static void southbridge_smi_mc(unsigned int node, smm_state_save_area_t *state_save)
 453 {
 454         u32 reg32;
 455
 456         reg32 = inl(pmbase + SMI_EN);
 457
 458         /* Are periodic SMIs enabled? */
 459         if ((reg32 & MCSMI_EN) == 0)
 460                 return;
 461
 462         printk_debug("Microcontroller SMI.\n");
 463 }
 464
 465
 466
 467 static void southbridge_smi_tco(unsigned int node, smm_state_save_area_t *state_save)
 468 {
 469         u32 tco_sts;
 470
 471         tco_sts = reset_tco_status();
 472
 473         /* Any TCO event? */
 474         if (!tco_sts)
 475                 return;
 476
 477         if (tco_sts & (1 << 8)) { // BIOSWR
 478                 u8 bios_cntl;
 479
 480                 bios_cntl = pcie_read_config16(PCI_DEV(0, 0x1f, 0), 0xdc);
 481
 482                 if (bios_cntl & 1) {
 483                         /* BWE is RW, so the SMI was caused by a
 484                          * write to BWE, not by a write to the BIOS
 485                          */
 486
 487                         /* This is the place where we notice someone
 488                          * is trying to tinker with the BIOS. We are
 489                          * trying to be nice and just ignore it. A more
 490                          * resolute answer would be to power down the
 491                          * box.
 492                          */
 493                         printk_debug("Switching back to RO\n");
 494                         pcie_write_config32(PCI_DEV(0, 0x1f, 0), 0xdc, (bios_cntl & ~1));
 495                 } /* No else for now? */
 496         } else if (tco_sts & (1 << 3)) { /* TIMEOUT */
 497                 /* Handle TCO timeout */
 498                 printk_debug("TCO Timeout.\n");
 499         } else if (!tco_sts) {
 500                 dump_tco_status(tco_sts);
 501         }
 502 }
 503
 504 static void southbridge_smi_periodic(unsigned int node, smm_state_save_area_t *state_save)
 505 {
 506         u32 reg32;
 507
 508         reg32 = inl(pmbase + SMI_EN);
 509
 510         /* Are periodic SMIs enabled? */
 511         if ((reg32 & PERIODIC_EN) == 0)
 512                 return;
 513
 514         printk_debug("Periodic SMI.\n");
 515 }
 516
 517 static void southbridge_smi_monitor(unsigned int node, smm_state_save_area_t *state_save)
 518 {
 519 #define IOTRAP(x) (trap_sts & (1 << x))
 520         u32 trap_sts, trap_cycle;
 521         u32 data, mask = 0;
 522         int i;
 523
 524         trap_sts = RCBA32(0x1e00); // TRSR - Trap Status Register
 525         RCBA32(0x1e00) = trap_sts; // Clear trap(s) in TRSR
 526
 527         trap_cycle = RCBA32(0x1e10);
 528         for (i=16; i<20; i++) {
 529                 if (trap_cycle & (1 << i))
 530                         mask |= (0xff << ((i - 16) << 2));
 531         }
 532
 533
 534         /* IOTRAP(3) SMI function call */
 535         if (IOTRAP(3)) {
 536                 if (gnvs && gnvs->smif)
 537                         io_trap_handler(gnvs->smif); // call function smif
 538                 return;
 539         }
 540
 541         /* IOTRAP(2) currently unused
 542          * IOTRAP(1) currently unused */
 543
 544         /* IOTRAP(0) SMIC */
 545         if (IOTRAP(0)) {
 546                 if (!(trap_cycle & (1 << 24))) { // It's a write
 547                         printk_debug("SMI1 command\n");
 548                         data = RCBA32(0x1e18);
 549                         data &= mask;
 550                         // if (smi1)
 551                         //      southbridge_smi_command(data);
 552                         // return;
 553                 }
 554                 // Fall through to debug
 555         }
 556
 557         printk_debug("  trapped io address = 0x%x\n", trap_cycle & 0xfffc);
 558         for (i=0; i < 4; i++) if(IOTRAP(i)) printk_debug("  TRAP = %d\n", i);
 559         printk_debug("  AHBE = %x\n", (trap_cycle >> 16) & 0xf);
 560         printk_debug("  MASK = 0x%08x\n", mask);
 561         printk_debug("  read/write: %s\n", (trap_cycle & (1 << 24)) ? "read" : "write");
 562
 563         if (!(trap_cycle & (1 << 24))) {
 564                 /* Write Cycle */
 565                 data = RCBA32(0x1e18);
 566                 printk_debug("  iotrap written data = 0x%08x\n", data);
 567         }
 568 #undef IOTRAP
 569 }
 570
 571 typedef void (*smi_handler)(unsigned int node,
 572                 smm_state_save_area_t *state_save);
 573
 574 smi_handler southbridge_smi[32] = {
 575         NULL,                     //  [0] reserved
 576         NULL,                     //  [1] reserved
 577         NULL,                     //  [2] BIOS_STS
 578         NULL,                     //  [3] LEGACY_USB_STS
 579         southbridge_smi_sleep,    //  [4] SLP_SMI_STS
 580         southbridge_smi_apmc,     //  [5] APM_STS
 581         NULL,                     //  [6] SWSMI_TMR_STS
 582         NULL,                     //  [7] reserved
 583         southbridge_smi_pm1,      //  [8] PM1_STS
 584         southbridge_smi_gpe0,     //  [9] GPE0_STS
 585         southbridge_smi_gpi,      // [10] GPI_STS
 586         southbridge_smi_mc,       // [11] MCSMI_STS
 587         NULL,                     // [12] DEVMON_STS
 588         southbridge_smi_tco,      // [13] TCO_STS
 589         southbridge_smi_periodic, // [14] PERIODIC_STS
 590         NULL,                     // [15] SERIRQ_SMI_STS
 591         NULL,                     // [16] SMBUS_SMI_STS
 592         NULL,                     // [17] LEGACY_USB2_STS
 593         NULL,                     // [18] INTEL_USB2_STS
 594         NULL,                     // [19] reserved
 595         NULL,                     // [20] PCI_EXP_SMI_STS
 596         southbridge_smi_monitor,  // [21] MONITOR_STS
 597         NULL,                     // [22] reserved
 598         NULL,                     // [23] reserved
 599         NULL,                     // [24] reserved
 600         NULL,                     // [25] EL_SMI_STS
 601         NULL,                     // [26] SPI_STS
 602         NULL,                     // [27] reserved
 603         NULL,                     // [28] reserved
 604         NULL,                     // [29] reserved
 605         NULL,                     // [30] reserved
 606         NULL                      // [31] reserved
 607 };
 608
 609 /**
 610  * @brief Interrupt handler for SMI#
 611  *
 612  * @param smm_revision revision of the smm state save map
 613  */
 614
 615 void southbridge_smi_handler(unsigned int node, smm_state_save_area_t *state_save)
 616 {
 617         int i, dump = 0;
 618         u32 smi_sts;
 619
 620         /* Update global variable pmbase */
 621         pmbase = pcie_read_config16(PCI_DEV(0, 0x1f, 0), 0x40) & 0xfffc;
 622
 623         /* We need to clear the SMI status registers, or we won't see what's
 624          * happening in the following calls.
 625          */
 626         smi_sts = reset_smi_status();
 627
 628         /* Filter all non-enabled SMI events */
 629         // FIXME Double check, this clears MONITOR
 630         // smi_sts &= inl(pmbase + SMI_EN);
 631
 632         /* Call SMI sub handler for each of the status bits */
 633         for (i = 0; i < 31; i++) {
 634                 if (smi_sts & (1 << i)) {
 635                         if (southbridge_smi[i])
 636                                 southbridge_smi[i](node, state_save);
 637                         else {
 638                                 printk_debug("SMI_STS[%d] occured, but no "
 639                                                 "handler available.\n", i);
 640                                 dump = 1;
 641                         }
 642                 }
 643         }
 644
 645         if(dump) {
 646                 dump_smi_status(smi_sts);
 647         }
 648
 649 }