src/smm.c

   1 // System Management Mode support (on emulators)
   2 //
   3 // Copyright (C) 2008  Kevin O'Connor <kevin@koconnor.net>
   4 // Copyright (C) 2006 Fabrice Bellard
   5 //
   6 // This file may be distributed under the terms of the GNU LGPLv3 license.
   7
   8 #include "pci.h" // pci_config_writel
   9 #include "util.h" // wbinvd
  10 #include "config.h" // CONFIG_*
  11 #include "ioport.h" // outb
  12 #include "pci_ids.h" // PCI_VENDOR_ID_INTEL
  13
  14 #if CONFIG_USE_SMM
  15 asm(
  16     ".global smm_relocation_start\n"
  17     ".global smm_relocation_end\n"
  18     ".global smm_code_start\n"
  19     ".global smm_code_end\n"
  20     "  .code16\n"
  21
  22     /* code to relocate SMBASE to 0xa0000 */
  23     "smm_relocation_start:\n"
  24     "  mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7efc, %ebx\n"
  25     "  addr32 mov (%ebx), %al\n"  /* revision ID to see if x86_64 or x86 */
  26     "  cmp $0x64, %al\n"
  27     "  je 1f\n"
  28     "  mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7ef8, %ebx\n"
  29     "  jmp 2f\n"
  30     "1:\n"
  31     "  mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7f00, %ebx\n"
  32     "2:\n"
  33     "  movl $" __stringify(BUILD_SMM_ADDR) " - 0x8000, %eax\n"
  34     "  addr32 movl %eax, (%ebx)\n"
  35     /* indicate to the BIOS that the SMM code was executed */
  36     "  mov $0x00, %al\n"
  37     "  movw $" __stringify(PORT_SMI_STATUS) ", %dx\n"
  38     "  outb %al, %dx\n"
  39     "  rsm\n"
  40     "smm_relocation_end:\n"
  41
  42     /* minimal SMM code to enable or disable ACPI */
  43     "smm_code_start:\n"
  44     "  movw $" __stringify(PORT_SMI_CMD) ", %dx\n"
  45     "  inb %dx, %al\n"
  46     "  cmp $0xf0, %al\n"
  47     "  jne 1f\n"
  48
  49     /* ACPI disable */
  50     "  mov $" __stringify(PORT_ACPI_PM_BASE) " + 0x04, %dx\n" /* PMCNTRL */
  51     "  inw %dx, %ax\n"
  52     "  andw $~1, %ax\n"
  53     "  outw %ax, %dx\n"
  54
  55     "  jmp 2f\n"
  56
  57     "1:\n"
  58     "  cmp $0xf1, %al\n"
  59     "  jne 2f\n"
  60
  61     /* ACPI enable */
  62     "  mov $" __stringify(PORT_ACPI_PM_BASE) " + 0x04, %dx\n" /* PMCNTRL */
  63     "  inw %dx, %ax\n"
  64     "  orw $1, %ax\n"
  65     "  outw %ax, %dx\n"
  66
  67     "2:\n"
  68     "  rsm\n"
  69     "smm_code_end:\n"
  70     "  .code32\n"
  71     );
  72 #endif
  73
  74 extern u8 smm_relocation_start, smm_relocation_end;
  75 extern u8 smm_code_start, smm_code_end;
  76
  77 void
  78 smm_init()
  79 {
  80     if (CONFIG_COREBOOT)
  81         // SMM only supported on emulators.
  82         return;
  83     if (!CONFIG_USE_SMM)
  84         return;
  85
  86     dprintf(3, "init smm\n");
  87
  88     // This code is hardcoded for PIIX4 Power Management device.
  89     int bdf = pci_find_device(PCI_VENDOR_ID_INTEL
  90                               , PCI_DEVICE_ID_INTEL_82371AB_3);
  91     if (bdf < 0)
  92         // Device not found
  93         return;
  94     int i440_bdf = pci_find_device(PCI_VENDOR_ID_INTEL
  95                                    , PCI_DEVICE_ID_INTEL_82441);
  96     if (i440_bdf < 0)
  97         return;
  98
  99     /* check if SMM init is already done */
 100     u32 value = pci_config_readl(bdf, 0x58);
 101     if (value & (1 << 25))
 102         return;
 103
 104     /* enable the SMM memory window */
 105     pci_config_writeb(i440_bdf, 0x72, 0x02 | 0x48);
 106
 107     /* save original memory content */
 108     memcpy((void *)BUILD_SMM_ADDR, (void *)BUILD_SMM_INIT_ADDR, BUILD_SMM_SIZE);
 109
 110     /* copy the SMM relocation code */
 111     memcpy((void *)BUILD_SMM_INIT_ADDR, &smm_relocation_start,
 112            &smm_relocation_end - &smm_relocation_start);
 113
 114     /* enable SMI generation when writing to the APMC register */
 115     pci_config_writel(bdf, 0x58, value | (1 << 25));
 116
 117     /* init APM status port */
 118     outb(0x01, PORT_SMI_STATUS);
 119
 120     /* raise an SMI interrupt */
 121     outb(0x00, PORT_SMI_CMD);
 122
 123     /* wait until SMM code executed */
 124     while (inb(PORT_SMI_STATUS) != 0x00)
 125         ;
 126
 127     /* restore original memory content */
 128     memcpy((void *)BUILD_SMM_INIT_ADDR, (void *)BUILD_SMM_ADDR, BUILD_SMM_SIZE);
 129
 130     /* copy the SMM code */
 131     memcpy((void *)BUILD_SMM_ADDR, &smm_code_start
 132            , &smm_code_end - &smm_code_start);
 133     wbinvd();
 134
 135     /* close the SMM memory window and enable normal SMM */
 136     pci_config_writeb(i440_bdf, 0x72, 0x02 | 0x08);
 137 }