blob: 9881ffe4ed88da228bef98facc89bf2beae2bcba [file] [log] [blame]
Stefan Reinauer688b3852004-01-28 16:56:14 +00001/*
Uwe Hermannc70e9fc2010-02-15 23:10:19 +00002 * This file is part of the coreboot project.
3 *
Stefan Reinauerf8ee1802008-01-18 15:08:58 +00004 * coreboot ACPI Table support
Stefan Reinauer688b3852004-01-28 16:56:14 +00005 * written by Stefan Reinauer <stepan@openbios.org>
Uwe Hermannc70e9fc2010-02-15 23:10:19 +00006 *
7 * Copyright (C) 2004 SUSE LINUX AG
8 * Copyright (C) 2005-2009 coresystems GmbH
Stefan Reinauer777224c2005-01-19 14:06:41 +00009 *
Stefan Reinauer14e22772010-04-27 06:56:47 +000010 * ACPI FADT, FACS, and DSDT table support added by
Ronald G. Minnich02fa3b22004-10-06 17:33:54 +000011 * Nick Barker <nick.barker9@btinternet.com>, and those portions
Uwe Hermannc70e9fc2010-02-15 23:10:19 +000012 * Copyright (C) 2004 Nick Barker
Stefan Reinauerf622d592005-11-26 16:56:05 +000013 *
Uwe Hermannc70e9fc2010-02-15 23:10:19 +000014 * Copyright (C) 2005 ADVANCED MICRO DEVICES, INC. All Rights Reserved.
Stefan Reinauerd6edf7a2006-01-05 00:19:52 +000015 * 2005.9 yhlu add SRAT table generation
Stefan Reinauer777224c2005-01-19 14:06:41 +000016 */
17
Stefan Reinauer14e22772010-04-27 06:56:47 +000018/*
Stefan Reinauer777224c2005-01-19 14:06:41 +000019 * Each system port implementing ACPI has to provide two functions:
Stefan Reinauer14e22772010-04-27 06:56:47 +000020 *
Stefan Reinauer777224c2005-01-19 14:06:41 +000021 * write_acpi_tables()
22 * acpi_dump_apics()
Stefan Reinauer14e22772010-04-27 06:56:47 +000023 *
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000024 * See Kontron 986LCD-M port for a good example of an ACPI implementation
25 * in coreboot.
Ronald G. Minnich02fa3b22004-10-06 17:33:54 +000026 */
Stefan Reinauer688b3852004-01-28 16:56:14 +000027
28#include <console/console.h>
29#include <string.h>
30#include <arch/acpi.h>
Rudolf Marek293b5f52009-02-01 18:35:15 +000031#include <arch/acpigen.h>
Stefan Reinauer777224c2005-01-19 14:06:41 +000032#include <device/pci.h>
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000033#include <cbmem.h>
Patrick Georgic8feedd2012-02-16 18:43:25 +010034#include <cpu/x86/lapic_def.h>
Duncan Lauriecde78012011-10-19 15:32:39 -070035#if CONFIG_COLLECT_TIMESTAMPS
36#include <timestamp.h>
37#endif
Ronald G. Minnich02fa3b22004-10-06 17:33:54 +000038
Patrick Georgi9aeb6942012-10-05 21:54:38 +020039/* FIXME: Kconfig doesn't support overridable defaults :-( */
40#ifndef CONFIG_HPET_MIN_TICKS
41#define CONFIG_HPET_MIN_TICKS 0x1000
42#endif
43
Ronald G. Minnich02fa3b22004-10-06 17:33:54 +000044u8 acpi_checksum(u8 *table, u32 length)
Stefan Reinauer688b3852004-01-28 16:56:14 +000045{
Uwe Hermann622824c2010-11-19 15:14:42 +000046 u8 ret = 0;
Stefan Reinauer688b3852004-01-28 16:56:14 +000047 while (length--) {
48 ret += *table;
49 table++;
50 }
Stefan Reinauera7648c22004-01-29 17:31:34 +000051 return -ret;
Stefan Reinauer688b3852004-01-28 16:56:14 +000052}
53
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000054/**
Uwe Hermann622824c2010-11-19 15:14:42 +000055 * Add an ACPI table to the RSDT (and XSDT) structure, recalculate length
56 * and checksum.
Stefan Reinauer06feb882004-02-03 16:11:35 +000057 */
Stefan Reinauerb657a3c2009-07-21 21:38:33 +000058void acpi_add_table(acpi_rsdp_t *rsdp, void *table)
Stefan Reinauer688b3852004-01-28 16:56:14 +000059{
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000060 int i, entries_num;
Stefan Reinauerb657a3c2009-07-21 21:38:33 +000061 acpi_rsdt_t *rsdt;
62 acpi_xsdt_t *xsdt = NULL;
63
Uwe Hermann622824c2010-11-19 15:14:42 +000064 /* The RSDT is mandatory... */
Stefan Reinauerb657a3c2009-07-21 21:38:33 +000065 rsdt = (acpi_rsdt_t *)rsdp->rsdt_address;
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000066
Uwe Hermann622824c2010-11-19 15:14:42 +000067 /* ...while the XSDT is not. */
68 if (rsdp->xsdt_address)
Stefan Reinauerb657a3c2009-07-21 21:38:33 +000069 xsdt = (acpi_xsdt_t *)((u32)rsdp->xsdt_address);
Stefan Reinauer14e22772010-04-27 06:56:47 +000070
Uwe Hermann622824c2010-11-19 15:14:42 +000071 /* This should always be MAX_ACPI_TABLES. */
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000072 entries_num = ARRAY_SIZE(rsdt->entry);
Stefan Reinauer14e22772010-04-27 06:56:47 +000073
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000074 for (i = 0; i < entries_num; i++) {
Uwe Hermann622824c2010-11-19 15:14:42 +000075 if (rsdt->entry[i] == 0)
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000076 break;
Stefan Reinauer688b3852004-01-28 16:56:14 +000077 }
78
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000079 if (i >= entries_num) {
Uwe Hermann622824c2010-11-19 15:14:42 +000080 printk(BIOS_ERR, "ACPI: Error: Could not add ACPI table, "
Cristian Măgherușan-Stanciuba482812011-07-02 00:57:07 +030081 "too many tables.\n");
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000082 return;
83 }
84
Uwe Hermann622824c2010-11-19 15:14:42 +000085 /* Add table to the RSDT. */
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000086 rsdt->entry[i] = (u32)table;
87
Uwe Hermann622824c2010-11-19 15:14:42 +000088 /* Fix RSDT length or the kernel will assume invalid entries. */
89 rsdt->header.length = sizeof(acpi_header_t) + (sizeof(u32) * (i + 1));
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000090
Uwe Hermann622824c2010-11-19 15:14:42 +000091 /* Re-calculate checksum. */
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000092 rsdt->header.checksum = 0; /* Hope this won't get optimized away */
Uwe Hermann622824c2010-11-19 15:14:42 +000093 rsdt->header.checksum = acpi_checksum((u8 *)rsdt, rsdt->header.length);
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000094
Uwe Hermann622824c2010-11-19 15:14:42 +000095 /*
96 * And now the same thing for the XSDT. We use the same index as for
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +000097 * now we want the XSDT and RSDT to always be in sync in coreboot.
98 */
99 if (xsdt) {
Uwe Hermann622824c2010-11-19 15:14:42 +0000100 /* Add table to the XSDT. */
101 xsdt->entry[i] = (u64)(u32)table;
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000102
Uwe Hermann622824c2010-11-19 15:14:42 +0000103 /* Fix XSDT length. */
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000104 xsdt->header.length = sizeof(acpi_header_t) +
Cristian Măgherușan-Stanciuba482812011-07-02 00:57:07 +0300105 (sizeof(u64) * (i + 1));
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000106
Uwe Hermann622824c2010-11-19 15:14:42 +0000107 /* Re-calculate checksum. */
108 xsdt->header.checksum = 0;
109 xsdt->header.checksum = acpi_checksum((u8 *)xsdt,
Cristian Măgherușan-Stanciuba482812011-07-02 00:57:07 +0300110 xsdt->header.length);
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000111 }
112
Uwe Hermann622824c2010-11-19 15:14:42 +0000113 printk(BIOS_DEBUG, "ACPI: added table %d/%d, length now %d\n",
Cristian Măgherușan-Stanciuba482812011-07-02 00:57:07 +0300114 i + 1, entries_num, rsdt->header.length);
Stefan Reinauer688b3852004-01-28 16:56:14 +0000115}
116
Uwe Hermann622824c2010-11-19 15:14:42 +0000117int acpi_create_mcfg_mmconfig(acpi_mcfg_mmconfig_t *mmconfig, u32 base,
Cristian Măgherușan-Stanciuba482812011-07-02 00:57:07 +0300118 u16 seg_nr, u8 start, u8 end)
Stefan Reinauer26d431a2009-01-20 19:17:51 +0000119{
Rudolf Mareke6409f22007-11-03 12:50:26 +0000120 mmconfig->base_address = base;
121 mmconfig->base_reserved = 0;
122 mmconfig->pci_segment_group_number = seg_nr;
123 mmconfig->start_bus_number = start;
124 mmconfig->end_bus_number = end;
Uwe Hermann622824c2010-11-19 15:14:42 +0000125
126 return sizeof(acpi_mcfg_mmconfig_t);
Rudolf Mareke6409f22007-11-03 12:50:26 +0000127}
128
Stefan Reinauer777224c2005-01-19 14:06:41 +0000129int acpi_create_madt_lapic(acpi_madt_lapic_t *lapic, u8 cpu, u8 apic)
Stefan Reinauer06feb882004-02-03 16:11:35 +0000130{
Uwe Hermann622824c2010-11-19 15:14:42 +0000131 lapic->type = 0; /* Local APIC structure */
132 lapic->length = sizeof(acpi_madt_lapic_t);
133 lapic->flags = (1 << 0); /* Processor/LAPIC enabled */
134 lapic->processor_id = cpu;
135 lapic->apic_id = apic;
Stefan Reinauer14e22772010-04-27 06:56:47 +0000136
Uwe Hermann622824c2010-11-19 15:14:42 +0000137 return lapic->length;
Stefan Reinauer06feb882004-02-03 16:11:35 +0000138}
139
Stefan Reinauerda65fbf2009-04-22 08:18:37 +0000140unsigned long acpi_create_madt_lapics(unsigned long current)
141{
142 device_t cpu;
143 int cpu_index = 0;
144
Uwe Hermann622824c2010-11-19 15:14:42 +0000145 for (cpu = all_devices; cpu; cpu = cpu->next) {
Stefan Reinauerda65fbf2009-04-22 08:18:37 +0000146 if ((cpu->path.type != DEVICE_PATH_APIC) ||
Cristian Măgherușan-Stanciuba482812011-07-02 00:57:07 +0300147 (cpu->bus->dev->path.type != DEVICE_PATH_APIC_CLUSTER)) {
Stefan Reinauerda65fbf2009-04-22 08:18:37 +0000148 continue;
149 }
Uwe Hermann622824c2010-11-19 15:14:42 +0000150 if (!cpu->enabled)
Stefan Reinauerda65fbf2009-04-22 08:18:37 +0000151 continue;
Uwe Hermann622824c2010-11-19 15:14:42 +0000152 current += acpi_create_madt_lapic((acpi_madt_lapic_t *)current,
153 cpu_index, cpu->path.apic.apic_id);
Stefan Reinauerda65fbf2009-04-22 08:18:37 +0000154 cpu_index++;
155 }
Uwe Hermann622824c2010-11-19 15:14:42 +0000156
Stefan Reinauerda65fbf2009-04-22 08:18:37 +0000157 return current;
158}
159
Uwe Hermann622824c2010-11-19 15:14:42 +0000160int acpi_create_madt_ioapic(acpi_madt_ioapic_t *ioapic, u8 id, u32 addr,
Cristian Măgherușan-Stanciuba482812011-07-02 00:57:07 +0300161 u32 gsi_base)
Stefan Reinauer06feb882004-02-03 16:11:35 +0000162{
Uwe Hermann622824c2010-11-19 15:14:42 +0000163 ioapic->type = 1; /* I/O APIC structure */
164 ioapic->length = sizeof(acpi_madt_ioapic_t);
165 ioapic->reserved = 0x00;
166 ioapic->gsi_base = gsi_base;
167 ioapic->ioapic_id = id;
168 ioapic->ioapic_addr = addr;
Stefan Reinauer14e22772010-04-27 06:56:47 +0000169
Uwe Hermann622824c2010-11-19 15:14:42 +0000170 return ioapic->length;
Stefan Reinauer06feb882004-02-03 16:11:35 +0000171}
172
Stefan Reinauer777224c2005-01-19 14:06:41 +0000173int acpi_create_madt_irqoverride(acpi_madt_irqoverride_t *irqoverride,
Stefan Reinauer06feb882004-02-03 16:11:35 +0000174 u8 bus, u8 source, u32 gsirq, u16 flags)
175{
Uwe Hermann622824c2010-11-19 15:14:42 +0000176 irqoverride->type = 2; /* Interrupt source override */
177 irqoverride->length = sizeof(acpi_madt_irqoverride_t);
178 irqoverride->bus = bus;
179 irqoverride->source = source;
180 irqoverride->gsirq = gsirq;
181 irqoverride->flags = flags;
Stefan Reinauer14e22772010-04-27 06:56:47 +0000182
Uwe Hermann622824c2010-11-19 15:14:42 +0000183 return irqoverride->length;
Stefan Reinauer06feb882004-02-03 16:11:35 +0000184}
185
Stefan Reinauer777224c2005-01-19 14:06:41 +0000186int acpi_create_madt_lapic_nmi(acpi_madt_lapic_nmi_t *lapic_nmi, u8 cpu,
Cristian Măgherușan-Stanciuba482812011-07-02 00:57:07 +0300187 u16 flags, u8 lint)
Stefan Reinauer06feb882004-02-03 16:11:35 +0000188{
Uwe Hermann622824c2010-11-19 15:14:42 +0000189 lapic_nmi->type = 4; /* Local APIC NMI structure */
190 lapic_nmi->length = sizeof(acpi_madt_lapic_nmi_t);
191 lapic_nmi->flags = flags;
192 lapic_nmi->processor_id = cpu;
193 lapic_nmi->lint = lint;
Stefan Reinauer14e22772010-04-27 06:56:47 +0000194
Uwe Hermann622824c2010-11-19 15:14:42 +0000195 return lapic_nmi->length;
Stefan Reinauer06feb882004-02-03 16:11:35 +0000196}
197
Stefan Reinauer777224c2005-01-19 14:06:41 +0000198void acpi_create_madt(acpi_madt_t *madt)
Stefan Reinauer06feb882004-02-03 16:11:35 +0000199{
Uwe Hermann622824c2010-11-19 15:14:42 +0000200 acpi_header_t *header = &(madt->header);
201 unsigned long current = (unsigned long)madt + sizeof(acpi_madt_t);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000202
Stefan Reinauer06feb882004-02-03 16:11:35 +0000203 memset((void *)madt, 0, sizeof(acpi_madt_t));
Stefan Reinauer14e22772010-04-27 06:56:47 +0000204
Uwe Hermann622824c2010-11-19 15:14:42 +0000205 /* Fill out header fields. */
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000206 memcpy(header->signature, "APIC", 4);
Stefan Reinauer06feb882004-02-03 16:11:35 +0000207 memcpy(header->oem_id, OEM_ID, 6);
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000208 memcpy(header->oem_table_id, ACPI_TABLE_CREATOR, 8);
Stefan Reinauer06feb882004-02-03 16:11:35 +0000209 memcpy(header->asl_compiler_id, ASLC, 4);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000210
Stefan Reinauer06feb882004-02-03 16:11:35 +0000211 header->length = sizeof(acpi_madt_t);
Uwe Hermann622824c2010-11-19 15:14:42 +0000212 header->revision = 1; /* ACPI 1.0/2.0: 1, ACPI 3.0: 2, ACPI 4.0: 3 */
Stefan Reinauer06feb882004-02-03 16:11:35 +0000213
Uwe Hermann622824c2010-11-19 15:14:42 +0000214 madt->lapic_addr = LOCAL_APIC_ADDR;
215 madt->flags = 0x1; /* PCAT_COMPAT */
Stefan Reinauer06feb882004-02-03 16:11:35 +0000216
Stefan Reinauerf622d592005-11-26 16:56:05 +0000217 current = acpi_fill_madt(current);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000218
Uwe Hermann622824c2010-11-19 15:14:42 +0000219 /* (Re)calculate length and checksum. */
220 header->length = current - (unsigned long)madt;
Stefan Reinauer14e22772010-04-27 06:56:47 +0000221
Uwe Hermann622824c2010-11-19 15:14:42 +0000222 header->checksum = acpi_checksum((void *)madt, header->length);
Stefan Reinauer06feb882004-02-03 16:11:35 +0000223}
224
Uwe Hermann622824c2010-11-19 15:14:42 +0000225/* MCFG is defined in the PCI Firmware Specification 3.0. */
Rudolf Mareke6409f22007-11-03 12:50:26 +0000226void acpi_create_mcfg(acpi_mcfg_t *mcfg)
227{
Uwe Hermann622824c2010-11-19 15:14:42 +0000228 acpi_header_t *header = &(mcfg->header);
229 unsigned long current = (unsigned long)mcfg + sizeof(acpi_mcfg_t);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000230
Rudolf Mareke6409f22007-11-03 12:50:26 +0000231 memset((void *)mcfg, 0, sizeof(acpi_mcfg_t));
Stefan Reinauer14e22772010-04-27 06:56:47 +0000232
Uwe Hermann622824c2010-11-19 15:14:42 +0000233 /* Fill out header fields. */
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000234 memcpy(header->signature, "MCFG", 4);
Rudolf Mareke6409f22007-11-03 12:50:26 +0000235 memcpy(header->oem_id, OEM_ID, 6);
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000236 memcpy(header->oem_table_id, ACPI_TABLE_CREATOR, 8);
Rudolf Mareke6409f22007-11-03 12:50:26 +0000237 memcpy(header->asl_compiler_id, ASLC, 4);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000238
Rudolf Mareke6409f22007-11-03 12:50:26 +0000239 header->length = sizeof(acpi_mcfg_t);
240 header->revision = 1;
241
242 current = acpi_fill_mcfg(current);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000243
Uwe Hermann622824c2010-11-19 15:14:42 +0000244 /* (Re)calculate length and checksum. */
245 header->length = current - (unsigned long)mcfg;
246 header->checksum = acpi_checksum((void *)mcfg, header->length);
Rudolf Mareke6409f22007-11-03 12:50:26 +0000247}
248
Uwe Hermann622824c2010-11-19 15:14:42 +0000249/*
250 * This can be overriden by platform ACPI setup code, if it calls
251 * acpi_create_ssdt_generator().
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000252 */
Uwe Hermann622824c2010-11-19 15:14:42 +0000253unsigned long __attribute__((weak)) acpi_fill_ssdt_generator(
254 unsigned long current, const char *oem_table_id)
255{
Rudolf Marek293b5f52009-02-01 18:35:15 +0000256 return current;
257}
258
Myles Watson3fe6b702009-10-09 20:13:43 +0000259void acpi_create_ssdt_generator(acpi_header_t *ssdt, const char *oem_table_id)
Rudolf Marek293b5f52009-02-01 18:35:15 +0000260{
Uwe Hermann622824c2010-11-19 15:14:42 +0000261 unsigned long current = (unsigned long)ssdt + sizeof(acpi_header_t);
262
Rudolf Marek293b5f52009-02-01 18:35:15 +0000263 memset((void *)ssdt, 0, sizeof(acpi_header_t));
Uwe Hermann622824c2010-11-19 15:14:42 +0000264
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000265 memcpy(&ssdt->signature, "SSDT", 4);
Uwe Hermann622824c2010-11-19 15:14:42 +0000266 ssdt->revision = 2; /* ACPI 1.0/2.0: ?, ACPI 3.0/4.0: 2 */
Rudolf Marek293b5f52009-02-01 18:35:15 +0000267 memcpy(&ssdt->oem_id, OEM_ID, 6);
268 memcpy(&ssdt->oem_table_id, oem_table_id, 8);
269 ssdt->oem_revision = 42;
Uwe Hermann622824c2010-11-19 15:14:42 +0000270 memcpy(&ssdt->asl_compiler_id, ASLC, 4);
Rudolf Marek293b5f52009-02-01 18:35:15 +0000271 ssdt->asl_compiler_revision = 42;
272 ssdt->length = sizeof(acpi_header_t);
273
Stefan Reinauer8dcd50b2009-03-06 17:24:29 +0000274 acpigen_set_current((char *) current);
Rudolf Marek293b5f52009-02-01 18:35:15 +0000275 current = acpi_fill_ssdt_generator(current, oem_table_id);
276
Uwe Hermann622824c2010-11-19 15:14:42 +0000277 /* (Re)calculate length and checksum. */
Rudolf Marek293b5f52009-02-01 18:35:15 +0000278 ssdt->length = current - (unsigned long)ssdt;
279 ssdt->checksum = acpi_checksum((void *)ssdt, ssdt->length);
280}
281
Stefan Reinauerf622d592005-11-26 16:56:05 +0000282int acpi_create_srat_lapic(acpi_srat_lapic_t *lapic, u8 node, u8 apic)
283{
Myles Watson0b4c9f02009-03-10 18:06:47 +0000284 memset((void *)lapic, 0, sizeof(acpi_srat_lapic_t));
Stefan Reinauerf622d592005-11-26 16:56:05 +0000285
Uwe Hermann622824c2010-11-19 15:14:42 +0000286 lapic->type = 0; /* Processor local APIC/SAPIC affinity structure */
287 lapic->length = sizeof(acpi_srat_lapic_t);
288 lapic->flags = (1 << 0); /* Enabled (the use of this structure). */
289 lapic->proximity_domain_7_0 = node;
290 /* TODO: proximity_domain_31_8, local SAPIC EID, clock domain. */
291 lapic->apic_id = apic;
Stefan Reinauerf622d592005-11-26 16:56:05 +0000292
Uwe Hermann622824c2010-11-19 15:14:42 +0000293 return lapic->length;
Stefan Reinauerf622d592005-11-26 16:56:05 +0000294}
295
Uwe Hermann622824c2010-11-19 15:14:42 +0000296int acpi_create_srat_mem(acpi_srat_mem_t *mem, u8 node, u32 basek, u32 sizek,
Cristian Măgherușan-Stanciuba482812011-07-02 00:57:07 +0300297 u32 flags)
Stefan Reinauerf622d592005-11-26 16:56:05 +0000298{
Uwe Hermann622824c2010-11-19 15:14:42 +0000299 mem->type = 1; /* Memory affinity structure */
300 mem->length = sizeof(acpi_srat_mem_t);
301 mem->base_address_low = (basek << 10);
302 mem->base_address_high = (basek >> (32 - 10));
303 mem->length_low = (sizek << 10);
304 mem->length_high = (sizek >> (32 - 10));
305 mem->proximity_domain = node;
Stefan Reinauer14e22772010-04-27 06:56:47 +0000306 mem->flags = flags;
Stefan Reinauerf622d592005-11-26 16:56:05 +0000307
Uwe Hermann622824c2010-11-19 15:14:42 +0000308 return mem->length;
Stefan Reinauerf622d592005-11-26 16:56:05 +0000309}
310
Uwe Hermann622824c2010-11-19 15:14:42 +0000311/* http://www.microsoft.com/whdc/system/sysinternals/sratdwn.mspx */
Stefan Reinauerf622d592005-11-26 16:56:05 +0000312void acpi_create_srat(acpi_srat_t *srat)
313{
Uwe Hermann622824c2010-11-19 15:14:42 +0000314 acpi_header_t *header = &(srat->header);
315 unsigned long current = (unsigned long)srat + sizeof(acpi_srat_t);
Stefan Reinauerf622d592005-11-26 16:56:05 +0000316
Uwe Hermann622824c2010-11-19 15:14:42 +0000317 memset((void *)srat, 0, sizeof(acpi_srat_t));
Stefan Reinauerf622d592005-11-26 16:56:05 +0000318
Uwe Hermann622824c2010-11-19 15:14:42 +0000319 /* Fill out header fields. */
320 memcpy(header->signature, "SRAT", 4);
321 memcpy(header->oem_id, OEM_ID, 6);
322 memcpy(header->oem_table_id, ACPI_TABLE_CREATOR, 8);
323 memcpy(header->asl_compiler_id, ASLC, 4);
Stefan Reinauerf622d592005-11-26 16:56:05 +0000324
Uwe Hermann622824c2010-11-19 15:14:42 +0000325 header->length = sizeof(acpi_srat_t);
326 header->revision = 1; /* ACPI 1.0: N/A, 2.0: 1, 3.0: 2, 4.0: 3 */
Stefan Reinauerf622d592005-11-26 16:56:05 +0000327
Uwe Hermann622824c2010-11-19 15:14:42 +0000328 srat->resv = 1; /* Spec: Reserved to 1 for backwards compatibility. */
Stefan Reinauerf622d592005-11-26 16:56:05 +0000329
Uwe Hermann622824c2010-11-19 15:14:42 +0000330 current = acpi_fill_srat(current);
Stefan Reinauerf622d592005-11-26 16:56:05 +0000331
Uwe Hermann622824c2010-11-19 15:14:42 +0000332 /* (Re)calculate length and checksum. */
333 header->length = current - (unsigned long)srat;
334 header->checksum = acpi_checksum((void *)srat, header->length);
Stefan Reinauerf622d592005-11-26 16:56:05 +0000335}
336
Uwe Hermann622824c2010-11-19 15:14:42 +0000337/* http://h21007.www2.hp.com/portal/download/files/unprot/Itanium/slit.pdf */
Yinghai Lud4b278c2006-10-04 20:46:15 +0000338void acpi_create_slit(acpi_slit_t *slit)
339{
Uwe Hermann622824c2010-11-19 15:14:42 +0000340 acpi_header_t *header = &(slit->header);
341 unsigned long current = (unsigned long)slit + sizeof(acpi_slit_t);
Yinghai Lud4b278c2006-10-04 20:46:15 +0000342
Uwe Hermann622824c2010-11-19 15:14:42 +0000343 memset((void *)slit, 0, sizeof(acpi_slit_t));
Yinghai Lud4b278c2006-10-04 20:46:15 +0000344
Uwe Hermann622824c2010-11-19 15:14:42 +0000345 /* Fill out header fields. */
346 memcpy(header->signature, "SLIT", 4);
347 memcpy(header->oem_id, OEM_ID, 6);
348 memcpy(header->oem_table_id, ACPI_TABLE_CREATOR, 8);
349 memcpy(header->asl_compiler_id, ASLC, 4);
Yinghai Lud4b278c2006-10-04 20:46:15 +0000350
Uwe Hermann622824c2010-11-19 15:14:42 +0000351 header->length = sizeof(acpi_slit_t);
352 header->revision = 1; /* ACPI 1.0: N/A, ACPI 2.0/3.0/4.0: 1 */
Yinghai Lud4b278c2006-10-04 20:46:15 +0000353
Uwe Hermann622824c2010-11-19 15:14:42 +0000354 current = acpi_fill_slit(current);
Yinghai Lud4b278c2006-10-04 20:46:15 +0000355
Uwe Hermann622824c2010-11-19 15:14:42 +0000356 /* (Re)calculate length and checksum. */
357 header->length = current - (unsigned long)slit;
358 header->checksum = acpi_checksum((void *)slit, header->length);
Yinghai Lud4b278c2006-10-04 20:46:15 +0000359}
360
Uwe Hermann622824c2010-11-19 15:14:42 +0000361/* http://www.intel.com/hardwaredesign/hpetspec_1.pdf */
Stefan Reinauer777224c2005-01-19 14:06:41 +0000362void acpi_create_hpet(acpi_hpet_t *hpet)
Stefan Reinauer688b3852004-01-28 16:56:14 +0000363{
Uwe Hermann622824c2010-11-19 15:14:42 +0000364 acpi_header_t *header = &(hpet->header);
365 acpi_addr_t *addr = &(hpet->addr);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000366
Stefan Reinauera7648c22004-01-29 17:31:34 +0000367 memset((void *)hpet, 0, sizeof(acpi_hpet_t));
Stefan Reinauer14e22772010-04-27 06:56:47 +0000368
Uwe Hermann622824c2010-11-19 15:14:42 +0000369 /* Fill out header fields. */
Stefan Reinauer4704dc52009-07-22 01:11:37 +0000370 memcpy(header->signature, "HPET", 4);
Stefan Reinauer688b3852004-01-28 16:56:14 +0000371 memcpy(header->oem_id, OEM_ID, 6);
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000372 memcpy(header->oem_table_id, ACPI_TABLE_CREATOR, 8);
Stefan Reinauer688b3852004-01-28 16:56:14 +0000373 memcpy(header->asl_compiler_id, ASLC, 4);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000374
Stefan Reinauer688b3852004-01-28 16:56:14 +0000375 header->length = sizeof(acpi_hpet_t);
Uwe Hermann622824c2010-11-19 15:14:42 +0000376 header->revision = 1; /* Currently 1. Table added in ACPI 2.0. */
Stefan Reinauer688b3852004-01-28 16:56:14 +0000377
Uwe Hermann622824c2010-11-19 15:14:42 +0000378 /* Fill out HPET address. */
379 addr->space_id = 0; /* Memory */
380 addr->bit_width = 64;
381 addr->bit_offset = 0;
Patrick Georgi9aeb6942012-10-05 21:54:38 +0200382 addr->addrl = CONFIG_HPET_ADDRESS & 0xffffffff;
383 addr->addrh = ((unsigned long long)CONFIG_HPET_ADDRESS) >> 32;
Stefan Reinauer688b3852004-01-28 16:56:14 +0000384
Patrick Georgi9aeb6942012-10-05 21:54:38 +0200385 hpet->id = *(unsigned int*)CONFIG_HPET_ADDRESS;
Uwe Hermann622824c2010-11-19 15:14:42 +0000386 hpet->number = 0;
Patrick Georgi9aeb6942012-10-05 21:54:38 +0200387 hpet->min_tick = CONFIG_HPET_MIN_TICKS;
Stefan Reinauer14e22772010-04-27 06:56:47 +0000388
Uwe Hermann622824c2010-11-19 15:14:42 +0000389 header->checksum = acpi_checksum((void *)hpet, sizeof(acpi_hpet_t));
Stefan Reinauer688b3852004-01-28 16:56:14 +0000390}
Uwe Hermann622824c2010-11-19 15:14:42 +0000391
Stefan Reinauer777224c2005-01-19 14:06:41 +0000392void acpi_create_facs(acpi_facs_t *facs)
Ronald G. Minnich02fa3b22004-10-06 17:33:54 +0000393{
Uwe Hermann622824c2010-11-19 15:14:42 +0000394 memset((void *)facs, 0, sizeof(acpi_facs_t));
Ronald G. Minnich02fa3b22004-10-06 17:33:54 +0000395
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000396 memcpy(facs->signature, "FACS", 4);
Ronald G. Minnich02fa3b22004-10-06 17:33:54 +0000397 facs->length = sizeof(acpi_facs_t);
398 facs->hardware_signature = 0;
399 facs->firmware_waking_vector = 0;
400 facs->global_lock = 0;
401 facs->flags = 0;
402 facs->x_firmware_waking_vector_l = 0;
403 facs->x_firmware_waking_vector_h = 0;
Uwe Hermann622824c2010-11-19 15:14:42 +0000404 facs->version = 1; /* ACPI 1.0: 0, ACPI 2.0/3.0: 1, ACPI 4.0: 2 */
Ronald G. Minnich02fa3b22004-10-06 17:33:54 +0000405}
Stefan Reinauer777224c2005-01-19 14:06:41 +0000406
407void acpi_write_rsdt(acpi_rsdt_t *rsdt)
Stefan Reinauer14e22772010-04-27 06:56:47 +0000408{
Uwe Hermann622824c2010-11-19 15:14:42 +0000409 acpi_header_t *header = &(rsdt->header);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000410
Uwe Hermann622824c2010-11-19 15:14:42 +0000411 /* Fill out header fields. */
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000412 memcpy(header->signature, "RSDT", 4);
Stefan Reinauer688b3852004-01-28 16:56:14 +0000413 memcpy(header->oem_id, OEM_ID, 6);
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000414 memcpy(header->oem_table_id, ACPI_TABLE_CREATOR, 8);
Stefan Reinauer688b3852004-01-28 16:56:14 +0000415 memcpy(header->asl_compiler_id, ASLC, 4);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000416
Stefan Reinauer688b3852004-01-28 16:56:14 +0000417 header->length = sizeof(acpi_rsdt_t);
Uwe Hermann622824c2010-11-19 15:14:42 +0000418 header->revision = 1; /* ACPI 1.0/2.0/3.0/4.0: 1 */
Stefan Reinauer14e22772010-04-27 06:56:47 +0000419
Uwe Hermann622824c2010-11-19 15:14:42 +0000420 /* Entries are filled in later, we come with an empty set. */
Stefan Reinauer688b3852004-01-28 16:56:14 +0000421
Uwe Hermann622824c2010-11-19 15:14:42 +0000422 /* Fix checksum. */
Stefan Reinauerb657a3c2009-07-21 21:38:33 +0000423 header->checksum = acpi_checksum((void *)rsdt, sizeof(acpi_rsdt_t));
Stefan Reinauer688b3852004-01-28 16:56:14 +0000424}
425
Stefan Reinauerb657a3c2009-07-21 21:38:33 +0000426void acpi_write_xsdt(acpi_xsdt_t *xsdt)
Stefan Reinauer14e22772010-04-27 06:56:47 +0000427{
Uwe Hermann622824c2010-11-19 15:14:42 +0000428 acpi_header_t *header = &(xsdt->header);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000429
Uwe Hermann622824c2010-11-19 15:14:42 +0000430 /* Fill out header fields. */
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000431 memcpy(header->signature, "XSDT", 4);
Stefan Reinauerb657a3c2009-07-21 21:38:33 +0000432 memcpy(header->oem_id, OEM_ID, 6);
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000433 memcpy(header->oem_table_id, ACPI_TABLE_CREATOR, 8);
Stefan Reinauerb657a3c2009-07-21 21:38:33 +0000434 memcpy(header->asl_compiler_id, ASLC, 4);
Stefan Reinauer14e22772010-04-27 06:56:47 +0000435
Stefan Reinauerb657a3c2009-07-21 21:38:33 +0000436 header->length = sizeof(acpi_xsdt_t);
Uwe Hermann622824c2010-11-19 15:14:42 +0000437 header->revision = 1; /* ACPI 1.0: N/A, 2.0/3.0/4.0: 1 */
Stefan Reinauer14e22772010-04-27 06:56:47 +0000438
Uwe Hermann622824c2010-11-19 15:14:42 +0000439 /* Entries are filled in later, we come with an empty set. */
Stefan Reinauerb657a3c2009-07-21 21:38:33 +0000440
Uwe Hermann622824c2010-11-19 15:14:42 +0000441 /* Fix checksum. */
Stefan Reinauerb657a3c2009-07-21 21:38:33 +0000442 header->checksum = acpi_checksum((void *)xsdt, sizeof(acpi_xsdt_t));
443}
444
445void acpi_write_rsdp(acpi_rsdp_t *rsdp, acpi_rsdt_t *rsdt, acpi_xsdt_t *xsdt)
Stefan Reinauer688b3852004-01-28 16:56:14 +0000446{
Stefan Reinauerd18faac2009-11-05 18:06:43 +0000447 memset(rsdp, 0, sizeof(acpi_rsdp_t));
Uwe Hermann622824c2010-11-19 15:14:42 +0000448
Stefan Reinauer688b3852004-01-28 16:56:14 +0000449 memcpy(rsdp->signature, RSDP_SIG, 8);
450 memcpy(rsdp->oem_id, OEM_ID, 6);
Uwe Hermann622824c2010-11-19 15:14:42 +0000451
452 rsdp->length = sizeof(acpi_rsdp_t);
453 rsdp->rsdt_address = (u32)rsdt;
454
455 /*
456 * Revision: ACPI 1.0: 0, ACPI 2.0/3.0/4.0: 2.
457 *
458 * Some OSes expect an XSDT to be present for RSD PTR revisions >= 2.
459 * If we don't have an ACPI XSDT, force ACPI 1.0 (and thus RSD PTR
460 * revision 0).
Stefan Reinauerb657a3c2009-07-21 21:38:33 +0000461 */
462 if (xsdt == NULL) {
Uwe Hermann622824c2010-11-19 15:14:42 +0000463 rsdp->revision = 0;
Stefan Reinauerb657a3c2009-07-21 21:38:33 +0000464 } else {
Uwe Hermann622824c2010-11-19 15:14:42 +0000465 rsdp->xsdt_address = (u64)(u32)xsdt;
466 rsdp->revision = 2;
Stefan Reinauerb657a3c2009-07-21 21:38:33 +0000467 }
Uwe Hermann622824c2010-11-19 15:14:42 +0000468
469 /* Calculate checksums. */
470 rsdp->checksum = acpi_checksum((void *)rsdp, 20);
471 rsdp->ext_checksum = acpi_checksum((void *)rsdp, sizeof(acpi_rsdp_t));
Stefan Reinauer688b3852004-01-28 16:56:14 +0000472}
473
zbaocaf494c82012-04-13 13:57:14 +0800474unsigned long __attribute__((weak)) acpi_fill_hest(acpi_hest_t *hest)
475{
476 return (unsigned long)hest;
477}
478
479unsigned long acpi_create_hest_error_source(acpi_hest_t *hest, acpi_hest_esd_t *esd, u16 type, void *data, u16 data_len)
480{
481 acpi_header_t *header = &(hest->header);
482 acpi_hest_hen_t *hen;
483 void *pos;
484 u16 len;
485
486 pos = esd;
487 memset(pos, 0, sizeof(acpi_hest_esd_t));
488 len = 0;
489 esd->type = type; /* MCE */
490 esd->source_id = hest->error_source_count;
491 esd->flags = 0; /* FIRMWARE_FIRST */
492 esd->enabled = 1;
493 esd->prealloc_erecords = 1;
494 esd->max_section_per_record = 0x1;
495
496 len += sizeof(acpi_hest_esd_t);
497 pos = esd + 1;
498
499 switch (type) {
500 case 0: /* MCE */
501 break;
502 case 1: /* CMC */
503 hen = (acpi_hest_hen_t *) (pos);
504 memset(pos, 0, sizeof(acpi_hest_hen_t));
505 hen->type = 3; /* SCI? */
506 hen->length = sizeof(acpi_hest_hen_t);
507 hen->conf_we = 0; /* Configuration Write Enable. */
508 hen->poll_interval = 0;
509 hen->vector = 0;
510 hen->sw2poll_threshold_val = 0;
511 hen->sw2poll_threshold_win = 0;
512 hen->error_threshold_val = 0;
513 hen->error_threshold_win = 0;
514 len += sizeof(acpi_hest_hen_t);
515 pos = hen + 1;
516 break;
517 case 2: /* NMI */
518 case 6: /* AER Root Port */
519 case 7: /* AER Endpoint */
520 case 8: /* AER Bridge */
521 case 9: /* Generic Hardware Error Source. */
522 /* TODO: */
523 break;
524 default:
525 printk(BIOS_DEBUG, "Invalid type of Error Source.");
526 break;
527 }
528 hest->error_source_count ++;
529
530 memcpy(pos, data, data_len);
531 len += data_len;
532 header->length += len;
533
534 return len;
535}
536
537/* ACPI 4.0 */
538void acpi_write_hest(acpi_hest_t *hest)
539{
540 acpi_header_t *header = &(hest->header);
541
542 memset(hest, 0, sizeof(acpi_hest_t));
543
544 memcpy(header->signature, "HEST", 4);
545 memcpy(header->oem_id, OEM_ID, 6);
546 memcpy(header->oem_table_id, ACPI_TABLE_CREATOR, 8);
547 memcpy(header->asl_compiler_id, ASLC, 4);
548 header->length += sizeof(acpi_hest_t);
549 header->revision = 1;
550
551 acpi_fill_hest(hest);
552
553 /* Calculate checksums. */
554 header->checksum = acpi_checksum((void *)hest, header->length);
555}
556
Patrick Georgie1667822012-05-05 15:29:32 +0200557#if CONFIG_HAVE_ACPI_RESUME
Stefan Reinauer7e9771c2009-04-22 08:17:38 +0000558void suspend_resume(void)
559{
560 void *wake_vec;
561
Uwe Hermann622824c2010-11-19 15:14:42 +0000562 /* If we happen to be resuming find wakeup vector and jump to OS. */
Stefan Reinauer7e9771c2009-04-22 08:17:38 +0000563 wake_vec = acpi_find_wakeup_vector();
Stefan Reinauercb91e152012-04-03 23:28:22 +0200564 if (wake_vec) {
565 /* Call mainboard resume handler first, if defined. */
566 if (mainboard_suspend_resume)
567 mainboard_suspend_resume();
Stefan Reinauer7e9771c2009-04-22 08:17:38 +0000568 acpi_jump_to_wakeup(wake_vec);
Stefan Reinauercb91e152012-04-03 23:28:22 +0200569 }
Stefan Reinauer7e9771c2009-04-22 08:17:38 +0000570}
571
Uwe Hermann622824c2010-11-19 15:14:42 +0000572/* This is to be filled by SB code - startup value what was found. */
Stefan Reinauer7e9771c2009-04-22 08:17:38 +0000573u8 acpi_slp_type = 0;
Stefan Reinauer688b3852004-01-28 16:56:14 +0000574
Stefan Reinauerde3206a2010-02-22 06:09:43 +0000575static int acpi_is_wakeup(void)
Rudolf Marek33cafe52009-04-13 18:07:02 +0000576{
Tobias Diedrich4e22a3b2010-12-13 22:39:46 +0100577 /* Both resume from S2 and resume from S3 restart at CPU reset */
578 return (acpi_slp_type == 3 || acpi_slp_type == 2);
Rudolf Marek33cafe52009-04-13 18:07:02 +0000579}
580
581static acpi_rsdp_t *valid_rsdp(acpi_rsdp_t *rsdp)
582{
583 if (strncmp((char *)rsdp, RSDP_SIG, sizeof(RSDP_SIG) - 1) != 0)
584 return NULL;
585
Stefan Reinauerc02b4fc2010-03-22 11:42:32 +0000586 printk(BIOS_DEBUG, "Looking on %p for valid checksum\n", rsdp);
Rudolf Marek33cafe52009-04-13 18:07:02 +0000587
588 if (acpi_checksum((void *)rsdp, 20) != 0)
589 return NULL;
Stefan Reinauerc02b4fc2010-03-22 11:42:32 +0000590 printk(BIOS_DEBUG, "Checksum 1 passed\n");
Rudolf Marek33cafe52009-04-13 18:07:02 +0000591
592 if ((rsdp->revision > 1) && (acpi_checksum((void *)rsdp,
593 rsdp->length) != 0))
594 return NULL;
Stefan Reinauerc02b4fc2010-03-22 11:42:32 +0000595 printk(BIOS_DEBUG, "Checksum 2 passed all OK\n");
Rudolf Marek33cafe52009-04-13 18:07:02 +0000596
597 return rsdp;
598}
599
600static acpi_rsdp_t *rsdp;
601
602void *acpi_get_wakeup_rsdp(void)
603{
604 return rsdp;
605}
606
607void *acpi_find_wakeup_vector(void)
608{
609 char *p, *end;
Rudolf Marek33cafe52009-04-13 18:07:02 +0000610 acpi_rsdt_t *rsdt;
611 acpi_facs_t *facs;
612 acpi_fadt_t *fadt;
Uwe Hermann622824c2010-11-19 15:14:42 +0000613 void *wake_vec;
Rudolf Marek33cafe52009-04-13 18:07:02 +0000614 int i;
615
616 rsdp = NULL;
617
618 if (!acpi_is_wakeup())
619 return NULL;
620
Uwe Hermann622824c2010-11-19 15:14:42 +0000621 printk(BIOS_DEBUG, "Trying to find the wakeup vector...\n");
Rudolf Marek33cafe52009-04-13 18:07:02 +0000622
Uwe Hermann622824c2010-11-19 15:14:42 +0000623 /* Find RSDP. */
624 for (p = (char *)0xe0000; p < (char *)0xfffff; p += 16) {
625 if ((rsdp = valid_rsdp((acpi_rsdp_t *)p)))
Rudolf Marek33cafe52009-04-13 18:07:02 +0000626 break;
627 }
628
629 if (rsdp == NULL)
630 return NULL;
631
Stefan Reinauerc02b4fc2010-03-22 11:42:32 +0000632 printk(BIOS_DEBUG, "RSDP found at %p\n", rsdp);
Rudolf Marek33cafe52009-04-13 18:07:02 +0000633 rsdt = (acpi_rsdt_t *) rsdp->rsdt_address;
Stefan Reinauer14e22772010-04-27 06:56:47 +0000634
Uwe Hermann622824c2010-11-19 15:14:42 +0000635 end = (char *)rsdt + rsdt->header.length;
Stefan Reinauerc02b4fc2010-03-22 11:42:32 +0000636 printk(BIOS_DEBUG, "RSDT found at %p ends at %p\n", rsdt, end);
Rudolf Marek33cafe52009-04-13 18:07:02 +0000637
Uwe Hermann622824c2010-11-19 15:14:42 +0000638 for (i = 0; ((char *)&rsdt->entry[i]) < end; i++) {
639 fadt = (acpi_fadt_t *)rsdt->entry[i];
Stefan Reinauercdfe3762009-07-21 22:15:43 +0000640 if (strncmp((char *)fadt, "FACP", 4) == 0)
Rudolf Marek33cafe52009-04-13 18:07:02 +0000641 break;
642 fadt = NULL;
643 }
644
645 if (fadt == NULL)
646 return NULL;
647
Stefan Reinauerc02b4fc2010-03-22 11:42:32 +0000648 printk(BIOS_DEBUG, "FADT found at %p\n", fadt);
Stefan Reinauer69390db2009-05-26 12:33:52 +0000649 facs = (acpi_facs_t *)fadt->firmware_ctrl;
Rudolf Marek33cafe52009-04-13 18:07:02 +0000650
Stefan Reinauer7e9771c2009-04-22 08:17:38 +0000651 if (facs == NULL) {
Uwe Hermann622824c2010-11-19 15:14:42 +0000652 printk(BIOS_DEBUG, "No FACS found, wake up from S3 not "
653 "possible.\n");
Rudolf Marek33cafe52009-04-13 18:07:02 +0000654 return NULL;
Stefan Reinauer7e9771c2009-04-22 08:17:38 +0000655 }
Rudolf Marek33cafe52009-04-13 18:07:02 +0000656
Stefan Reinauerc02b4fc2010-03-22 11:42:32 +0000657 printk(BIOS_DEBUG, "FACS found at %p\n", facs);
Uwe Hermann622824c2010-11-19 15:14:42 +0000658 wake_vec = (void *)facs->firmware_waking_vector;
Stefan Reinauerc02b4fc2010-03-22 11:42:32 +0000659 printk(BIOS_DEBUG, "OS waking vector is %p\n", wake_vec);
Uwe Hermann622824c2010-11-19 15:14:42 +0000660
Rudolf Marek33cafe52009-04-13 18:07:02 +0000661 return wake_vec;
662}
663
Tobias Diedrich4e22a3b2010-12-13 22:39:46 +0100664#if CONFIG_SMP
Rudolf Marek33cafe52009-04-13 18:07:02 +0000665extern char *lowmem_backup;
666extern char *lowmem_backup_ptr;
667extern int lowmem_backup_size;
Tobias Diedrich4e22a3b2010-12-13 22:39:46 +0100668#endif
Rudolf Marek33cafe52009-04-13 18:07:02 +0000669
Uwe Hermann622824c2010-11-19 15:14:42 +0000670#define WAKEUP_BASE 0x600
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000671
Uwe Hermann622824c2010-11-19 15:14:42 +0000672void (*acpi_do_wakeup)(u32 vector, u32 backup_source, u32 backup_target,
673 u32 backup_size) __attribute__((regparm(0))) = (void *)WAKEUP_BASE;
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000674
675extern unsigned char __wakeup, __wakeup_size;
676
Rudolf Marek33cafe52009-04-13 18:07:02 +0000677void acpi_jump_to_wakeup(void *vector)
678{
Uwe Hermann622824c2010-11-19 15:14:42 +0000679 u32 acpi_backup_memory = (u32)cbmem_find(CBMEM_ID_RESUME);
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000680
681 if (!acpi_backup_memory) {
Uwe Hermann622824c2010-11-19 15:14:42 +0000682 printk(BIOS_WARNING, "ACPI: Backup memory missing. "
683 "No S3 resume.\n");
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000684 return;
685 }
686
Tobias Diedrich4e22a3b2010-12-13 22:39:46 +0100687#if CONFIG_SMP
Uwe Hermann622824c2010-11-19 15:14:42 +0000688 // FIXME: This should go into the ACPI backup memory, too. No pork saussages.
689 /*
690 * Just restore the SMP trampoline and continue with wakeup on
691 * assembly level.
692 */
Rudolf Marek33cafe52009-04-13 18:07:02 +0000693 memcpy(lowmem_backup_ptr, lowmem_backup, lowmem_backup_size);
Tobias Diedrich4e22a3b2010-12-13 22:39:46 +0100694#endif
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000695
Uwe Hermann622824c2010-11-19 15:14:42 +0000696 /* Copy wakeup trampoline in place. */
Stefan Reinauerde3206a2010-02-22 06:09:43 +0000697 memcpy((void *)WAKEUP_BASE, &__wakeup, (size_t)&__wakeup_size);
Stefan Reinauerc0ac7e92009-11-10 22:17:15 +0000698
Duncan Lauriecde78012011-10-19 15:32:39 -0700699#if CONFIG_COLLECT_TIMESTAMPS
700 timestamp_add_now(TS_ACPI_WAKE_JUMP);
701#endif
702
Uwe Hermann622824c2010-11-19 15:14:42 +0000703 acpi_do_wakeup((u32)vector, acpi_backup_memory, CONFIG_RAMBASE,
704 HIGH_MEMORY_SAVE);
Rudolf Marek33cafe52009-04-13 18:07:02 +0000705}
706#endif