[deliverable/linux.git] / arch / x86 / kernel / acpi / sleep.c

/*
 * sleep.c - x86-specific ACPI sleep support.
 *
 *  Copyright (C) 2001-2003 Patrick Mochel
 *  Copyright (C) 2001-2003 Pavel Machek <pavel@suse.cz>
 */

#include <linux/acpi.h>
#include <linux/bootmem.h>
#include <linux/dmi.h>
#include <linux/cpumask.h>

#include "realmode/wakeup.h"
#include "sleep.h"

unsigned long acpi_wakeup_address;
unsigned long acpi_realmode_flags;

/* address in low memory of the wakeup routine. */
static unsigned long acpi_realmode;

#ifdef CONFIG_64BIT
static char temp_stack[10240];
#endif

/**
 * acpi_save_state_mem - save kernel state
 *
 * Create an identity mapped page table and copy the wakeup routine to
 * low memory.
 *
 * Note that this is too late to change acpi_wakeup_address.
 */
int acpi_save_state_mem(void)
{
	struct wakeup_header *header;

	if (!acpi_realmode) {
		printk(KERN_ERR "Could not allocate memory during boot, "
		       "S3 disabled\n");
		return -ENOMEM;
	}
	memcpy((void *)acpi_realmode, &wakeup_code_start, WAKEUP_SIZE);

	header = (struct wakeup_header *)(acpi_realmode + HEADER_OFFSET);
	if (header->signature != 0x51ee1111) {
		printk(KERN_ERR "wakeup header does not match\n");
		return -EINVAL;
	}

	header->video_mode = saved_video_mode;

#ifndef CONFIG_64BIT
	store_gdt((struct desc_ptr *)&header->pmode_gdt);

	header->pmode_efer_low = nx_enabled;
	if (header->pmode_efer_low & 1) {
		/* This is strange, why not save efer, always? */
		rdmsr(MSR_EFER, header->pmode_efer_low,
			header->pmode_efer_high);
	}
#endif /* !CONFIG_64BIT */

	header->pmode_cr0 = read_cr0();
	header->pmode_cr4 = read_cr4();
	header->realmode_flags = acpi_realmode_flags;
	header->real_magic = 0x12345678;

#ifndef CONFIG_64BIT
	header->pmode_entry = (u32)&wakeup_pmode_return;
	header->pmode_cr3 = (u32)(swsusp_pg_dir - __PAGE_OFFSET);
	saved_magic = 0x12345678;
#else /* CONFIG_64BIT */
	header->trampoline_segment = setup_trampoline() >> 4;
	init_rsp = (unsigned long)temp_stack + 4096;
	initial_code = (unsigned long)wakeup_long64;
	saved_magic = 0x123456789abcdef0;
#endif /* CONFIG_64BIT */

	return 0;
}

/*
 * acpi_restore_state - undo effects of acpi_save_state_mem
 */
void acpi_restore_state_mem(void)
{
}


/**
 * acpi_reserve_bootmem - do _very_ early ACPI initialisation
 *
 * We allocate a page from the first 1MB of memory for the wakeup
 * routine for when we come back from a sleep state. The
 * runtime allocator allows specification of <16MB pages, but not
 * <1MB pages.
 */
void __init acpi_reserve_bootmem(void)
{
	if ((&wakeup_code_end - &wakeup_code_start) > WAKEUP_SIZE) {
		printk(KERN_ERR
		       "ACPI: Wakeup code way too big, S3 disabled.\n");
		return;
	}

	acpi_realmode = (unsigned long)alloc_bootmem_low(WAKEUP_SIZE);

	if (!acpi_realmode) {
		printk(KERN_ERR "ACPI: Cannot allocate lowmem, S3 disabled.\n");
		return;
	}

	acpi_wakeup_address = acpi_realmode;
}


static int __init acpi_sleep_setup(char *str)
{
	while ((str != NULL) && (*str != '\0')) {
		if (strncmp(str, "s3_bios", 7) == 0)
			acpi_realmode_flags |= 1;
		if (strncmp(str, "s3_mode", 7) == 0)
			acpi_realmode_flags |= 2;
		if (strncmp(str, "s3_beep", 7) == 0)
			acpi_realmode_flags |= 4;
		str = strchr(str, ',');
		if (str != NULL)
			str += strspn(str, ", \t");
	}
	return 1;
}

__setup("acpi_sleep=", acpi_sleep_setup);
Commit	Line	Data
4fc2fba8 PM	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@suse.cz>
	6	*/
	7
	8	#include <linux/acpi.h>
	9	#include <linux/bootmem.h>
	10	#include <linux/dmi.h>
	11	#include <linux/cpumask.h>
	12
e44b7b75 PM	13	#include "realmode/wakeup.h"
e44b7b75 PM	14	#include "sleep.h"
4fc2fba8	15
f49688d4	16	unsigned long acpi_wakeup_address;
4fc2fba8	17	unsigned long acpi_realmode_flags;
4fc2fba8	18
e44b7b75 PM	19	/* address in low memory of the wakeup routine. */
	20	static unsigned long acpi_realmode;
	21
	22	#ifdef CONFIG_64BIT
	23	static char temp_stack[10240];
	24	#endif
4fc2fba8 PM	25
	26	/**
	27	* acpi_save_state_mem - save kernel state
	28	*
	29	* Create an identity mapped page table and copy the wakeup routine to
	30	* low memory.
e44b7b75 PM	31	*
e44b7b75 PM	32	* Note that this is too late to change acpi_wakeup_address.
4fc2fba8 PM	33	*/
	34	int acpi_save_state_mem(void)
	35	{
e44b7b75 PM	36	struct wakeup_header *header;
	37
	38	if (!acpi_realmode) {
	39	printk(KERN_ERR "Could not allocate memory during boot, "
	40	"S3 disabled\n");
4fc2fba8 PM	41	return -ENOMEM;
4fc2fba8 PM	42	}
e44b7b75 PM	43	memcpy((void *)acpi_realmode, &wakeup_code_start, WAKEUP_SIZE);
	44
	45	header = (struct wakeup_header *)(acpi_realmode + HEADER_OFFSET);
	46	if (header->signature != 0x51ee1111) {
	47	printk(KERN_ERR "wakeup header does not match\n");
	48	return -EINVAL;
	49	}
	50
	51	header->video_mode = saved_video_mode;
	52
	53	#ifndef CONFIG_64BIT
	54	store_gdt((struct desc_ptr *)&header->pmode_gdt);
	55
	56	header->pmode_efer_low = nx_enabled;
	57	if (header->pmode_efer_low & 1) {
	58	/* This is strange, why not save efer, always? */
	59	rdmsr(MSR_EFER, header->pmode_efer_low,
	60	header->pmode_efer_high);
	61	}
	62	#endif /* !CONFIG_64BIT */
	63
	64	header->pmode_cr0 = read_cr0();
	65	header->pmode_cr4 = read_cr4();
	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)(swsusp_pg_dir - __PAGE_OFFSET);
	72	saved_magic = 0x12345678;
	73	#else /* CONFIG_64BIT */
	74	header->trampoline_segment = setup_trampoline() >> 4;
	75	init_rsp = (unsigned long)temp_stack + 4096;
	76	initial_code = (unsigned long)wakeup_long64;
	77	saved_magic = 0x123456789abcdef0;
	78	#endif /* CONFIG_64BIT */
4fc2fba8 PM	79
	80	return 0;
	81	}
	82
	83	/*
	84	* acpi_restore_state - undo effects of acpi_save_state_mem
	85	*/
	86	void acpi_restore_state_mem(void)
	87	{
	88	}
	89
	90
	91	/**
	92	* acpi_reserve_bootmem - do _very_ early ACPI initialisation
	93	*
	94	* We allocate a page from the first 1MB of memory for the wakeup
	95	* routine for when we come back from a sleep state. The
	96	* runtime allocator allows specification of <16MB pages, but not
	97	* <1MB pages.
	98	*/
	99	void __init acpi_reserve_bootmem(void)
	100	{
e44b7b75	101	if ((&wakeup_code_end - &wakeup_code_start) > WAKEUP_SIZE) {
4fc2fba8 PM	102	printk(KERN_ERR
	103	"ACPI: Wakeup code way too big, S3 disabled.\n");
	104	return;
	105	}
	106
e44b7b75 PM	107	acpi_realmode = (unsigned long)alloc_bootmem_low(WAKEUP_SIZE);
	108
	109	if (!acpi_realmode) {
4fc2fba8	110	printk(KERN_ERR "ACPI: Cannot allocate lowmem, S3 disabled.\n");
e44b7b75 PM	111	return;
	112	}
	113
	114	acpi_wakeup_address = acpi_realmode;
4fc2fba8 PM	115	}
	116
	117
	118	static int __init acpi_sleep_setup(char *str)
	119	{
	120	while ((str != NULL) && (*str != '\0')) {
	121	if (strncmp(str, "s3_bios", 7) == 0)
	122	acpi_realmode_flags \|= 1;
	123	if (strncmp(str, "s3_mode", 7) == 0)
	124	acpi_realmode_flags \|= 2;
	125	if (strncmp(str, "s3_beep", 7) == 0)
	126	acpi_realmode_flags \|= 4;
	127	str = strchr(str, ',');
	128	if (str != NULL)
	129	str += strspn(str, ", \t");
	130	}
	131	return 1;
	132	}
	133
	134	__setup("acpi_sleep=", acpi_sleep_setup);