Return to smm.c CVS log

Up to [Qemu by Fabrice Bellard] / qemu / roms / seabios / src

Annotation of qemu/roms/seabios/src/smm.c, revision 1.1.1.1

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

This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.