printk_foo -> printk(BIOS_FOO, ...)
[coreboot.git] / src / arch / i386 / boot / acpi.c
index 515976636d02c4a8170302fee50a36e4cc1b158c..9bab92831f5f248302e49994480445e97a004040 100644 (file)
@@ -1,14 +1,17 @@
 /*
+ * This file is part of the coreboot project.
+ *
  * coreboot ACPI Table support
  * written by Stefan Reinauer <stepan@openbios.org>
- *  Copyright (C) 2004 SUSE LINUX AG
- *  Copyright (C) 2005-2009 coresystems GmbH
+ *
+ * Copyright (C) 2004 SUSE LINUX AG
+ * Copyright (C) 2005-2009 coresystems GmbH
  *
  * ACPI FADT, FACS, and DSDT table support added by 
  * Nick Barker <nick.barker9@btinternet.com>, and those portions
- *  (C) Copyright 2004 Nick Barker
+ * Copyright (C) 2004 Nick Barker
  *
- * Copyright 2005 ADVANCED MICRO DEVICES, INC. All Rights Reserved.
+ * Copyright (C) 2005 ADVANCED MICRO DEVICES, INC. All Rights Reserved.
  * 2005.9 yhlu add SRAT table generation
  */
 
@@ -18,7 +21,8 @@
  *   write_acpi_tables()
  *   acpi_dump_apics()
  *   
- * See AMD Solo, Island Aruma or Via Epia-M port for more details.
+ * See Kontron 986LCD-M port for a good example of an ACPI implementation
+ * in coreboot.
  */
 
 #include <console/console.h>
@@ -26,6 +30,7 @@
 #include <arch/acpi.h>
 #include <arch/acpigen.h>
 #include <device/pci.h>
+#include <cbmem.h>
 
 u8 acpi_checksum(u8 *table, u32 length)
 {
@@ -37,54 +42,67 @@ u8 acpi_checksum(u8 *table, u32 length)
        return -ret;
 }
 
-/*
- * add an acpi table to rsdt structure, and recalculate checksum
+/**
+ * Add an ACPI table to the RSDT (and XSDT) structure, recalculate length and checksum
  */
 
 void acpi_add_table(acpi_rsdp_t *rsdp, void *table)
 {
-       int i;
+       int i, entries_num;
        acpi_rsdt_t *rsdt;
        acpi_xsdt_t *xsdt = NULL;
 
+       /* The RSDT is mandatory ... */
        rsdt = (acpi_rsdt_t *)rsdp->rsdt_address;
+
+       /* ... while the XSDT is not */
        if (rsdp->xsdt_address) {
                xsdt = (acpi_xsdt_t *)((u32)rsdp->xsdt_address);
        }
        
-       int entries_num = ARRAY_SIZE(rsdt->entry);
-       
-       for (i=0; i<entries_num; i++) {
-               if(rsdt->entry[i]==0) {
-                       rsdt->entry[i]=(u32)table;
-                       /* fix length to stop kernel whining about invalid entries */
-                       rsdt->header.length = sizeof(acpi_header_t) + (sizeof(u32) * (i+1));
-                       /* fix checksum */
-                       /* hope this won't get optimized away */
-                       rsdt->header.checksum=0;
-                       rsdt->header.checksum=acpi_checksum((u8 *)rsdt,
-                                       rsdt->header.length);
-
-                       /* And now the same thing for the XSDT. We use the same
-                        * index as we want the XSDT and RSDT to always be in
-                        * sync in coreboot.
-                        */
-                       if (xsdt) {
-                               xsdt->entry[i]=(u64)(u32)table;
-                               xsdt->header.length = sizeof(acpi_header_t) +
-                                       (sizeof(u64) * (i+1));
-                               xsdt->header.checksum=0;
-                               xsdt->header.checksum=acpi_checksum((u8 *)xsdt,
-                                               xsdt->header.length);
-                       }
-                       
-                       printk_debug("ACPI: added table %d/%d Length now %d\n",
-                                       i+1, entries_num, rsdt->header.length);
-                       return;
-               }
+       /* This should always be MAX_ACPI_TABLES */
+       entries_num = ARRAY_SIZE(rsdt->entry);
+       
+       for (i = 0; i < entries_num; i++) {
+               if(rsdt->entry[i] == 0)
+                       break;
+       }
+
+       if (i >= entries_num) {
+               printk(BIOS_ERR, "ACPI: Error: Could not add ACPI table, too many tables.\n");
+               return;
        }
 
-       printk_err("ACPI: Error: Could not add ACPI table, too many tables.\n");
+       /* Add table to the RSDT */
+       rsdt->entry[i] = (u32)table;
+
+       /* Fix RSDT length or the kernel will assume invalid entries */
+       rsdt->header.length = sizeof(acpi_header_t) + (sizeof(u32) * (i+1));
+
+       /* Re-calculate checksum */
+       rsdt->header.checksum = 0; /* Hope this won't get optimized away */
+       rsdt->header.checksum = acpi_checksum((u8 *)rsdt,
+                       rsdt->header.length);
+
+       /* And now the same thing for the XSDT. We use the same index as for
+        * now we want the XSDT and RSDT to always be in sync in coreboot.
+        */
+       if (xsdt) {
+               /* Add table to the XSDT */
+               xsdt->entry[i]=(u64)(u32)table;
+
+               /* Fix XSDT length */
+               xsdt->header.length = sizeof(acpi_header_t) +
+                       (sizeof(u64) * (i+1));
+
+               /* Re-calculate checksum */
+               xsdt->header.checksum=0;
+               xsdt->header.checksum=acpi_checksum((u8 *)xsdt,
+                               xsdt->header.length);
+       }
+
+       printk(BIOS_DEBUG, "ACPI: added table %d/%d Length now %d\n",
+                       i+1, entries_num, rsdt->header.length);
 }
 
 int acpi_create_mcfg_mmconfig(acpi_mcfg_mmconfig_t *mmconfig, u32 base, u16 seg_nr, u8 start, u8 end)
@@ -222,13 +240,14 @@ void acpi_create_mcfg(acpi_mcfg_t *mcfg)
 }
 
 /* this can be overriden by platform ACPI setup code,
-   if it calls acpi_create_ssdt_generator */
+ * if it calls acpi_create_ssdt_generator
+ */
 unsigned long __attribute__((weak)) acpi_fill_ssdt_generator(unsigned long current,
-                                                   char *oem_table_id) {
+                                                   const char *oem_table_id) {
        return current;
 }
 
-void acpi_create_ssdt_generator(acpi_header_t *ssdt, char *oem_table_id)
+void acpi_create_ssdt_generator(acpi_header_t *ssdt, const char *oem_table_id)
 {
        unsigned long current=(unsigned long)ssdt+sizeof(acpi_header_t);
        memset((void *)ssdt, 0, sizeof(acpi_header_t));
@@ -341,7 +360,7 @@ void acpi_create_hpet(acpi_hpet_t *hpet)
        memset((void *)hpet, 0, sizeof(acpi_hpet_t));
        
        /* fill out header fields */
-       memcpy(header->signature, HPET_NAME, 4);
+       memcpy(header->signature, "HPET", 4);
        memcpy(header->oem_id, OEM_ID, 6);
        memcpy(header->oem_table_id, ACPI_TABLE_CREATOR, 8);
        memcpy(header->asl_compiler_id, ASLC, 4);
@@ -424,6 +443,7 @@ void acpi_write_xsdt(acpi_xsdt_t *xsdt)
 
 void acpi_write_rsdp(acpi_rsdp_t *rsdp, acpi_rsdt_t *rsdt, acpi_xsdt_t *xsdt)
 {
+       memset(rsdp, 0, sizeof(acpi_rsdp_t));
        memcpy(rsdp->signature, RSDP_SIG, 8);
        memcpy(rsdp->oem_id, OEM_ID, 6);
        rsdp->length            = sizeof(acpi_rsdp_t);
@@ -467,7 +487,7 @@ void suspend_resume(void)
 /* this is to be filled by SB code - startup value what was found */
 u8 acpi_slp_type = 0;
 
-int acpi_is_wakeup(void)
+static int acpi_is_wakeup(void)
 {
        return (acpi_slp_type == 3);
 }
@@ -477,17 +497,17 @@ static acpi_rsdp_t *valid_rsdp(acpi_rsdp_t *rsdp)
        if (strncmp((char *)rsdp, RSDP_SIG, sizeof(RSDP_SIG) - 1) != 0)
                return NULL;
 
-       printk_debug("Looking on %p for valid checksum\n", rsdp);
+       printk(BIOS_DEBUG, "Looking on %p for valid checksum\n", rsdp);
 
        if (acpi_checksum((void *)rsdp, 20) != 0)
                return NULL;
-       printk_debug("Checksum 1 passed\n");
+       printk(BIOS_DEBUG, "Checksum 1 passed\n");
 
        if ((rsdp->revision > 1) && (acpi_checksum((void *)rsdp,
                                                rsdp->length) != 0))
                return NULL;
 
-       printk_debug("Checksum 2 passed all OK\n");
+       printk(BIOS_DEBUG, "Checksum 2 passed all OK\n");
 
        return rsdp;
 }
@@ -514,7 +534,7 @@ void *acpi_find_wakeup_vector(void)
        if (!acpi_is_wakeup())
                return NULL;
 
-       printk_debug("Trying to find the wakeup vector ...\n");
+       printk(BIOS_DEBUG, "Trying to find the wakeup vector ...\n");
 
        /* find RSDP */
        for (p = (char *) 0xe0000; p <  (char *) 0xfffff; p+=16) {
@@ -525,11 +545,11 @@ void *acpi_find_wakeup_vector(void)
        if (rsdp == NULL)
                return NULL;
 
-       printk_debug("RSDP found at %p\n", rsdp);
+       printk(BIOS_DEBUG, "RSDP found at %p\n", rsdp);
        rsdt = (acpi_rsdt_t *) rsdp->rsdt_address;
        
        end = (char *) rsdt + rsdt->header.length;
-       printk_debug("RSDT found at %p ends at %p\n", rsdt, end);
+       printk(BIOS_DEBUG, "RSDT found at %p ends at %p\n", rsdt, end);
 
        for (i = 0; ((char *) &rsdt->entry[i]) < end; i++) {
                fadt = (acpi_fadt_t *) rsdt->entry[i];
@@ -541,17 +561,17 @@ void *acpi_find_wakeup_vector(void)
        if (fadt == NULL)
                return NULL;
 
-       printk_debug("FADT found at %p\n", fadt);
+       printk(BIOS_DEBUG, "FADT found at %p\n", fadt);
        facs = (acpi_facs_t *)fadt->firmware_ctrl;
 
        if (facs == NULL) {
-               printk_debug("No FACS found, wake up from S3 not possible.\n");
+               printk(BIOS_DEBUG, "No FACS found, wake up from S3 not possible.\n");
                return NULL;
        }
 
-       printk_debug("FACS found at %p\n", facs);
+       printk(BIOS_DEBUG, "FACS found at %p\n", facs);
        wake_vec = (void *) facs->firmware_waking_vector;
-       printk_debug("OS waking vector is %p\n", wake_vec);
+       printk(BIOS_DEBUG, "OS waking vector is %p\n", wake_vec);
        return wake_vec;
 }
 
@@ -559,10 +579,29 @@ extern char *lowmem_backup;
 extern char *lowmem_backup_ptr;
 extern int lowmem_backup_size;
 
+#define WAKEUP_BASE            0x600
+
+void (*acpi_do_wakeup)(u32 vector, u32 backup_source, u32 backup_target, u32
+               backup_size) __attribute__((regparm(0))) = (void *)WAKEUP_BASE;
+
+extern unsigned char __wakeup, __wakeup_size;
+
 void acpi_jump_to_wakeup(void *vector)
 {
+       u32 acpi_backup_memory = (u32) cbmem_find(CBMEM_ID_RESUME);
+
+       if (!acpi_backup_memory) {
+               printk(BIOS_WARNING, "ACPI: Backup memory missing. No S3 Resume.\n");
+               return;
+       }
+
+       // FIXME this should go into the ACPI backup memory, too. No pork saussages.
        /* just restore the SMP trampoline and continue with wakeup on assembly level */
        memcpy(lowmem_backup_ptr, lowmem_backup, lowmem_backup_size);
-       acpi_jmp_to_realm_wakeup((u32) vector);
+
+       /* copy wakeup trampoline in place */
+       memcpy((void *)WAKEUP_BASE, &__wakeup, (size_t)&__wakeup_size);
+
+       acpi_do_wakeup((u32)vector, acpi_backup_memory, CONFIG_RAMBASE, HIGH_MEMORY_SAVE);
 }
 #endif