blob: 5a79269fde74ae63fb97e3314df1b43cf0d37050 [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//
6// This file may be distributed under the terms of the GNU GPLv3 license.
7
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'Connor40967022008-07-21 22:23:05 -040014#if CONFIG_USE_SMM
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040015asm(
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"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050024 " mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7efc, %ebx\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040025 " addr32 mov (%ebx), %al\n" /* revision ID to see if x86_64 or x86 */
26 " cmp $0x64, %al\n"
27 " je 1f\n"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050028 " mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7ef8, %ebx\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040029 " jmp 2f\n"
30 "1:\n"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050031 " mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7f00, %ebx\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040032 "2:\n"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050033 " movl $" __stringify(BUILD_SMM_ADDR) " - 0x8000, %eax\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040034 " addr32 movl %eax, (%ebx)\n"
35 /* indicate to the BIOS that the SMM code was executed */
36 " mov $0x00, %al\n"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050037 " movw $" __stringify(PORT_SMI_STATUS) ", %dx\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040038 " 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"
Kevin O'Connore682cbc2008-12-06 23:11:56 -050044 " movw $" __stringify(PORT_SMI_CMD) ", %dx\n"
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040045 " inb %dx, %al\n"
46 " cmp $0xf0, %al\n"
47 " jne 1f\n"
48
49 /* ACPI disable */
Kevin O'Connore682cbc2008-12-06 23:11:56 -050050 " mov $" __stringify(PORT_ACPI_PM_BASE) " + 0x04, %dx\n" /* PMCNTRL */
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040051 " 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 */
Kevin O'Connore682cbc2008-12-06 23:11:56 -050062 " mov $" __stringify(PORT_ACPI_PM_BASE) " + 0x04, %dx\n" /* PMCNTRL */
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040063 " 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 );
Kevin O'Connor40967022008-07-21 22:23:05 -040072#endif
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040073
74extern u8 smm_relocation_start, smm_relocation_end;
75extern u8 smm_code_start, smm_code_end;
76
77void
78smm_init()
79{
80 if (!CONFIG_USE_SMM)
81 return;
82
Kevin O'Connor7b49cd92008-11-08 10:35:26 -050083 dprintf(3, "init smm\n");
84
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040085 // This code is hardcoded for PIIX4 Power Management device.
Kevin O'Connor4132e022008-12-04 19:39:10 -050086 int bdf = pci_find_device(PCI_VENDOR_ID_INTEL
87 , PCI_DEVICE_ID_INTEL_82371AB_3);
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -050088 if (bdf < 0)
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040089 // Device not found
90 return;
Kevin O'Connor4132e022008-12-04 19:39:10 -050091 int i440_bdf = pci_find_device(PCI_VENDOR_ID_INTEL
92 , PCI_DEVICE_ID_INTEL_82441);
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -050093 if (i440_bdf < 0)
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040094 return;
95
96 /* check if SMM init is already done */
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -050097 u32 value = pci_config_readl(bdf, 0x58);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -040098 if (value & (1 << 25))
99 return;
100
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500101 /* enable the SMM memory window */
102 pci_config_writeb(i440_bdf, 0x72, 0x02 | 0x48);
103
104 /* save original memory content */
105 memcpy((void *)BUILD_SMM_ADDR, (void *)BUILD_SMM_INIT_ADDR, BUILD_SMM_SIZE);
106
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400107 /* copy the SMM relocation code */
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500108 memcpy((void *)BUILD_SMM_INIT_ADDR, &smm_relocation_start,
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400109 &smm_relocation_end - &smm_relocation_start);
110
111 /* enable SMI generation when writing to the APMC register */
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -0500112 pci_config_writel(bdf, 0x58, value | (1 << 25));
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400113
114 /* init APM status port */
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500115 outb(0x01, PORT_SMI_STATUS);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400116
117 /* raise an SMI interrupt */
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500118 outb(0x00, PORT_SMI_CMD);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400119
120 /* wait until SMM code executed */
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500121 while (inb(PORT_SMI_STATUS) != 0x00)
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400122 ;
123
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500124 /* restore original memory content */
125 memcpy((void *)BUILD_SMM_INIT_ADDR, (void *)BUILD_SMM_ADDR, BUILD_SMM_SIZE);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400126
127 /* copy the SMM code */
Kevin O'Connore682cbc2008-12-06 23:11:56 -0500128 memcpy((void *)BUILD_SMM_ADDR, &smm_code_start
129 , &smm_code_end - &smm_code_start);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400130 wbinvd();
131
132 /* close the SMM memory window and enable normal SMM */
Kevin O'Connorbe19cdc2008-11-09 15:33:47 -0500133 pci_config_writeb(i440_bdf, 0x72, 0x02 | 0x08);
Kevin O'Connorf7ba6d72008-07-04 05:05:54 -0400134}