blob: 31e56d8c285bac984ed6bcec65407ac88ff1a2c8 [file] [log] [blame]
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -04001// System Management Mode support (on emulators)
2//
3// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
4// Copyright (C) 2006 Fabrice Bellard
5//
Kevin O'Connorb1b7c2a2009-01-15 20:52:58 -05006// This file may be distributed under the terms of the GNU LGPLv3 license.
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -04007
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -05008#include "pci.h" // pci_config_writel
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -04009#include "util.h" // wbinvd
Kevin O'Connor9521e262008-07-04 13:04:29 -040010#include "config.h" // CONFIG_*
11#include "ioport.h" // outb
Kevin O'Connor2ed2f582008-11-08 15:53:36 -050012#include "pci_ids.h" // PCI_VENDOR_ID_INTEL
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040013
Kevin O'Connorc0693942009-06-10 21:56:01 -040014ASM32(
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040015 ".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"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050023 " mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7efc, %ebx\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040024 " addr32 mov (%ebx), %al\n" /* revision ID to see if x86_64 or x86 */
25 " cmp $0x64, %al\n"
26 " je 1f\n"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050027 " mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7ef8, %ebx\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040028 " jmp 2f\n"
29 "1:\n"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050030 " mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7f00, %ebx\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040031 "2:\n"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050032 " movl $" __stringify(BUILD_SMM_ADDR) " - 0x8000, %eax\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040033 " addr32 movl %eax, (%ebx)\n"
34 /* indicate to the BIOS that the SMM code was executed */
35 " mov $0x00, %al\n"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050036 " movw $" __stringify(PORT_SMI_STATUS) ", %dx\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040037 " 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"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050043 " movw $" __stringify(PORT_SMI_CMD) ", %dx\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040044 " inb %dx, %al\n"
45 " cmp $0xf0, %al\n"
46 " jne 1f\n"
47
48 /* ACPI disable */
Kevin O'Connore682cbc2008-12-06 23:11:56 -050049 " mov $" __stringify(PORT_ACPI_PM_BASE) " + 0x04, %dx\n" /* PMCNTRL */
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040050 " 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 */
Kevin O'Connore682cbc2008-12-06 23:11:56 -050061 " mov $" __stringify(PORT_ACPI_PM_BASE) " + 0x04, %dx\n" /* PMCNTRL */
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040062 " 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 );
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040071
72extern u8 smm_relocation_start, smm_relocation_end;
73extern u8 smm_code_start, smm_code_end;
74
75void
76smm_init()
77{
Kevin O'Connor4bbd3b32008-12-10 21:01:00 -050078 if (CONFIG_COREBOOT)
79 // SMM only supported on emulators.
80 return;
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040081 if (!CONFIG_USE_SMM)
82 return;
83
Kevin O'Connor7b49cd92008-11-08 10:35:26 -050084 dprintf(3, "init smm\n");
85
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040086 // This code is hardcoded for PIIX4 Power Management device.
Kevin O'Connor4132e022008-12-04 19:39:10 -050087 int bdf = pci_find_device(PCI_VENDOR_ID_INTEL
88 , PCI_DEVICE_ID_INTEL_82371AB_3);
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -050089 if (bdf < 0)
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040090 // Device not found
91 return;
Kevin O'Connor4132e022008-12-04 19:39:10 -050092 int i440_bdf = pci_find_device(PCI_VENDOR_ID_INTEL
93 , PCI_DEVICE_ID_INTEL_82441);
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -050094 if (i440_bdf < 0)
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040095 return;
96
97 /* check if SMM init is already done */
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -050098 u32 value = pci_config_readl(bdf, 0x58);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040099 if (value & (1 << 25))
100 return;
101
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500102 /* 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
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400108 /* copy the SMM relocation code */
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500109 memcpy((void *)BUILD_SMM_INIT_ADDR, &smm_relocation_start,
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400110 &smm_relocation_end - &smm_relocation_start);
111
112 /* enable SMI generation when writing to the APMC register */
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -0500113 pci_config_writel(bdf, 0x58, value | (1 << 25));
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400114
115 /* init APM status port */
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500116 outb(0x01, PORT_SMI_STATUS);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400117
118 /* raise an SMI interrupt */
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500119 outb(0x00, PORT_SMI_CMD);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400120
121 /* wait until SMM code executed */
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500122 while (inb(PORT_SMI_STATUS) != 0x00)
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400123 ;
124
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500125 /* restore original memory content */
126 memcpy((void *)BUILD_SMM_INIT_ADDR, (void *)BUILD_SMM_ADDR, BUILD_SMM_SIZE);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400127
128 /* copy the SMM code */
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500129 memcpy((void *)BUILD_SMM_ADDR, &smm_code_start
130 , &smm_code_end - &smm_code_start);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400131 wbinvd();
132
133 /* close the SMM memory window and enable normal SMM */
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -0500134 pci_config_writeb(i440_bdf, 0x72, 0x02 | 0x08);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400135}