1/*
  2 * sleep.c - x86-specific ACPI sleep support.
  3 *
  4 *  Copyright (C) 2001-2003 Patrick Mochel
  5 *  Copyright (C) 2001-2003 Pavel Machek <pavel@ucw.cz>
  6 */
  7
  8#include <linux/acpi.h>
  9#include <linux/bootmem.h>
 10#include <linux/memblock.h>
 11#include <linux/dmi.h>
 12#include <linux/cpumask.h>
 13#include <asm/segment.h>
 14#include <asm/desc.h>
 15#include <asm/pgtable.h>
 16#include <asm/cacheflush.h>
 17#include <asm/realmode.h>
 18
 19#include "../../realmode/rm/wakeup.h"
 20#include "sleep.h"
 21
 22unsigned long acpi_realmode_flags;
 23
 24#if defined(CONFIG_SMP) && defined(CONFIG_64BIT)
 25static char temp_stack[4096];
 26#endif
 27
 28asmlinkage void acpi_enter_s3(void)
 29{
 30	acpi_enter_sleep_state(3, wake_sleep_flags);
 31}
 32/**
 33 * acpi_suspend_lowlevel - save kernel state
 34 *
 35 * Create an identity mapped page table and copy the wakeup routine to
 36 * low memory.
 37 */
 38int acpi_suspend_lowlevel(void)
 39{
 40	struct wakeup_header *header =
 41		(struct wakeup_header *) __va(real_mode_header->wakeup_header);
 
 
 
 42
 
 43	if (header->signature != WAKEUP_HEADER_SIGNATURE) {
 44		printk(KERN_ERR "wakeup header does not match\n");
 45		return -EINVAL;
 46	}
 47
 48	header->video_mode = saved_video_mode;
 49
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 50#ifndef CONFIG_64BIT
 51	store_gdt((struct desc_ptr *)&header->pmode_gdt);
 52
 53	if (rdmsr_safe(MSR_EFER, &header->pmode_efer_low,
 54		       &header->pmode_efer_high))
 55		header->pmode_efer_low = header->pmode_efer_high = 0;
 56#endif /* !CONFIG_64BIT */
 57
 58	header->pmode_cr0 = read_cr0();
 59	header->pmode_cr4 = read_cr4_safe();
 60	header->pmode_behavior = 0;
 61	if (!rdmsr_safe(MSR_IA32_MISC_ENABLE,
 62			&header->pmode_misc_en_low,
 63			&header->pmode_misc_en_high))
 64		header->pmode_behavior |=
 65			(1 << WAKEUP_BEHAVIOR_RESTORE_MISC_ENABLE);
 66	header->realmode_flags = acpi_realmode_flags;
 67	header->real_magic = 0x12345678;
 68
 69#ifndef CONFIG_64BIT
 70	header->pmode_entry = (u32)&wakeup_pmode_return;
 71	header->pmode_cr3 = (u32)__pa(&initial_page_table);
 72	saved_magic = 0x12345678;
 73#else /* CONFIG_64BIT */
 
 74#ifdef CONFIG_SMP
 75	stack_start = (unsigned long)temp_stack + sizeof(temp_stack);
 76	early_gdt_descr.address =
 77			(unsigned long)get_cpu_gdt_table(smp_processor_id());
 78	initial_gs = per_cpu_offset(smp_processor_id());
 79#endif
 80	initial_code = (unsigned long)wakeup_long64;
 81       saved_magic = 0x123456789abcdef0L;
 82#endif /* CONFIG_64BIT */
 83
 84	do_suspend_lowlevel();
 85	return 0;
 86}
 87
 88static int __init acpi_sleep_setup(char *str)
 89{
 90	while ((str != NULL) && (*str != '\0')) {
 91		if (strncmp(str, "s3_bios", 7) == 0)
 92			acpi_realmode_flags |= 1;
 93		if (strncmp(str, "s3_mode", 7) == 0)
 94			acpi_realmode_flags |= 2;
 95		if (strncmp(str, "s3_beep", 7) == 0)
 96			acpi_realmode_flags |= 4;
 97#ifdef CONFIG_HIBERNATION
 98		if (strncmp(str, "s4_nohwsig", 10) == 0)
 99			acpi_no_s4_hw_signature();
100#endif
101		if (strncmp(str, "nonvs", 5) == 0)
102			acpi_nvs_nosave();
103		if (strncmp(str, "old_ordering", 12) == 0)
104			acpi_old_suspend_ordering();
105		str = strchr(str, ',');
106		if (str != NULL)
107			str += strspn(str, ", \t");
108	}
109	return 1;
110}
111
112__setup("acpi_sleep=", acpi_sleep_setup);

  1/*
  2 * sleep.c - x86-specific ACPI sleep support.
  3 *
  4 *  Copyright (C) 2001-2003 Patrick Mochel
  5 *  Copyright (C) 2001-2003 Pavel Machek <pavel@ucw.cz>
  6 */
  7
  8#include <linux/acpi.h>
  9#include <linux/bootmem.h>
 10#include <linux/memblock.h>
 11#include <linux/dmi.h>
 12#include <linux/cpumask.h>
 13#include <asm/segment.h>
 14#include <asm/desc.h>
 15#include <asm/pgtable.h>
 16#include <asm/cacheflush.h>
 
 17
 18#include "realmode/wakeup.h"
 19#include "sleep.h"
 20
 21unsigned long acpi_realmode_flags;
 22
 23#if defined(CONFIG_SMP) && defined(CONFIG_64BIT)
 24static char temp_stack[4096];
 25#endif
 26
 
 
 
 
 27/**
 28 * acpi_suspend_lowlevel - save kernel state
 29 *
 30 * Create an identity mapped page table and copy the wakeup routine to
 31 * low memory.
 32 */
 33int acpi_suspend_lowlevel(void)
 34{
 35	struct wakeup_header *header;
 36	/* address in low memory of the wakeup routine. */
 37	char *acpi_realmode;
 38
 39	acpi_realmode = TRAMPOLINE_SYM(acpi_wakeup_code);
 40
 41	header = (struct wakeup_header *)(acpi_realmode + WAKEUP_HEADER_OFFSET);
 42	if (header->signature != WAKEUP_HEADER_SIGNATURE) {
 43		printk(KERN_ERR "wakeup header does not match\n");
 44		return -EINVAL;
 45	}
 46
 47	header->video_mode = saved_video_mode;
 48
 49	header->wakeup_jmp_seg = acpi_wakeup_address >> 4;
 50
 51	/*
 52	 * Set up the wakeup GDT.  We set these up as Big Real Mode,
 53	 * that is, with limits set to 4 GB.  At least the Lenovo
 54	 * Thinkpad X61 is known to need this for the video BIOS
 55	 * initialization quirk to work; this is likely to also
 56	 * be the case for other laptops or integrated video devices.
 57	 */
 58
 59	/* GDT[0]: GDT self-pointer */
 60	header->wakeup_gdt[0] =
 61		(u64)(sizeof(header->wakeup_gdt) - 1) +
 62		((u64)__pa(&header->wakeup_gdt) << 16);
 63	/* GDT[1]: big real mode-like code segment */
 64	header->wakeup_gdt[1] =
 65		GDT_ENTRY(0x809b, acpi_wakeup_address, 0xfffff);
 66	/* GDT[2]: big real mode-like data segment */
 67	header->wakeup_gdt[2] =
 68		GDT_ENTRY(0x8093, acpi_wakeup_address, 0xfffff);
 69
 70#ifndef CONFIG_64BIT
 71	store_gdt((struct desc_ptr *)&header->pmode_gdt);
 72
 73	if (rdmsr_safe(MSR_EFER, &header->pmode_efer_low,
 74		       &header->pmode_efer_high))
 75		header->pmode_efer_low = header->pmode_efer_high = 0;
 76#endif /* !CONFIG_64BIT */
 77
 78	header->pmode_cr0 = read_cr0();
 79	header->pmode_cr4 = read_cr4_safe();
 80	header->pmode_behavior = 0;
 81	if (!rdmsr_safe(MSR_IA32_MISC_ENABLE,
 82			&header->pmode_misc_en_low,
 83			&header->pmode_misc_en_high))
 84		header->pmode_behavior |=
 85			(1 << WAKEUP_BEHAVIOR_RESTORE_MISC_ENABLE);
 86	header->realmode_flags = acpi_realmode_flags;
 87	header->real_magic = 0x12345678;
 88
 89#ifndef CONFIG_64BIT
 90	header->pmode_entry = (u32)&wakeup_pmode_return;
 91	header->pmode_cr3 = (u32)__pa(&initial_page_table);
 92	saved_magic = 0x12345678;
 93#else /* CONFIG_64BIT */
 94	header->trampoline_segment = trampoline_address() >> 4;
 95#ifdef CONFIG_SMP
 96	stack_start = (unsigned long)temp_stack + sizeof(temp_stack);
 97	early_gdt_descr.address =
 98			(unsigned long)get_cpu_gdt_table(smp_processor_id());
 99	initial_gs = per_cpu_offset(smp_processor_id());
100#endif
101	initial_code = (unsigned long)wakeup_long64;
102       saved_magic = 0x123456789abcdef0L;
103#endif /* CONFIG_64BIT */
104
105	do_suspend_lowlevel();
106	return 0;
107}
108
109static int __init acpi_sleep_setup(char *str)
110{
111	while ((str != NULL) && (*str != '\0')) {
112		if (strncmp(str, "s3_bios", 7) == 0)
113			acpi_realmode_flags |= 1;
114		if (strncmp(str, "s3_mode", 7) == 0)
115			acpi_realmode_flags |= 2;
116		if (strncmp(str, "s3_beep", 7) == 0)
117			acpi_realmode_flags |= 4;
118#ifdef CONFIG_HIBERNATION
119		if (strncmp(str, "s4_nohwsig", 10) == 0)
120			acpi_no_s4_hw_signature();
121#endif
122		if (strncmp(str, "nonvs", 5) == 0)
123			acpi_nvs_nosave();
124		if (strncmp(str, "old_ordering", 12) == 0)
125			acpi_old_suspend_ordering();
126		str = strchr(str, ',');
127		if (str != NULL)
128			str += strspn(str, ", \t");
129	}
130	return 1;
131}
132
133__setup("acpi_sleep=", acpi_sleep_setup);