2005-04-16 22:20:36 +00:00
/*
* Suspend support specific for i386 .
*
* Distribute under GPLv2
*
* Copyright ( c ) 2002 Pavel Machek < pavel @ suse . cz >
* Copyright ( c ) 2001 Patrick Mochel < mochel @ osdl . org >
*/
# include <linux/config.h>
# include <linux/module.h>
# include <linux/suspend.h>
2006-06-23 09:04:18 +00:00
# include <asm/mtrr.h>
2005-04-16 22:20:36 +00:00
static struct saved_context saved_context ;
unsigned long saved_context_ebx ;
unsigned long saved_context_esp , saved_context_ebp ;
unsigned long saved_context_esi , saved_context_edi ;
unsigned long saved_context_eflags ;
void __save_processor_state ( struct saved_context * ctxt )
{
kernel_fpu_begin ( ) ;
/*
* descriptor tables
*/
2005-09-03 22:56:38 +00:00
store_gdt ( & ctxt - > gdt_limit ) ;
store_idt ( & ctxt - > idt_limit ) ;
store_tr ( ctxt - > tr ) ;
2005-04-16 22:20:36 +00:00
/*
* segment registers
*/
2005-09-03 22:56:38 +00:00
savesegment ( es , ctxt - > es ) ;
savesegment ( fs , ctxt - > fs ) ;
savesegment ( gs , ctxt - > gs ) ;
savesegment ( ss , ctxt - > ss ) ;
2005-04-16 22:20:36 +00:00
/*
* control registers
*/
2005-09-03 22:56:36 +00:00
ctxt - > cr0 = read_cr0 ( ) ;
ctxt - > cr2 = read_cr2 ( ) ;
ctxt - > cr3 = read_cr3 ( ) ;
ctxt - > cr4 = read_cr4 ( ) ;
2005-04-16 22:20:36 +00:00
}
void save_processor_state ( void )
{
__save_processor_state ( & saved_context ) ;
}
2005-10-30 22:59:28 +00:00
static void do_fpu_end ( void )
2005-04-16 22:20:36 +00:00
{
2005-10-30 22:59:28 +00:00
/*
* Restore FPU regs if necessary .
*/
kernel_fpu_end ( ) ;
2005-04-16 22:20:36 +00:00
}
static void fix_processor_context ( void )
{
int cpu = smp_processor_id ( ) ;
struct tss_struct * t = & per_cpu ( init_tss , cpu ) ;
set_tss_desc ( cpu , t ) ; /* This just modifies memory; should not be necessary. But... This is necessary, because 386 hardware has concept of busy TSS or some similar stupidity. */
load_TR_desc ( ) ; /* This does ltr */
load_LDT ( & current - > active_mm - > context ) ; /* This does lldt */
/*
* Now maybe reload the debug registers
*/
if ( current - > thread . debugreg [ 7 ] ) {
2005-06-23 07:08:43 +00:00
set_debugreg ( current - > thread . debugreg [ 0 ] , 0 ) ;
set_debugreg ( current - > thread . debugreg [ 1 ] , 1 ) ;
set_debugreg ( current - > thread . debugreg [ 2 ] , 2 ) ;
set_debugreg ( current - > thread . debugreg [ 3 ] , 3 ) ;
/* no 4 and 5 */
set_debugreg ( current - > thread . debugreg [ 6 ] , 6 ) ;
set_debugreg ( current - > thread . debugreg [ 7 ] , 7 ) ;
2005-04-16 22:20:36 +00:00
}
}
void __restore_processor_state ( struct saved_context * ctxt )
{
/*
* control registers
*/
2005-09-03 22:56:36 +00:00
write_cr4 ( ctxt - > cr4 ) ;
write_cr3 ( ctxt - > cr3 ) ;
write_cr2 ( ctxt - > cr2 ) ;
2006-05-23 05:35:29 +00:00
write_cr0 ( ctxt - > cr0 ) ;
2005-04-16 22:20:36 +00:00
2005-06-25 21:55:14 +00:00
/*
* now restore the descriptor tables to their proper values
* ltr is done i fix_processor_context ( ) .
*/
2005-09-03 22:56:38 +00:00
load_gdt ( & ctxt - > gdt_limit ) ;
load_idt ( & ctxt - > idt_limit ) ;
2005-06-25 21:55:14 +00:00
2005-04-16 22:20:36 +00:00
/*
* segment registers
*/
2005-09-03 22:56:38 +00:00
loadsegment ( es , ctxt - > es ) ;
loadsegment ( fs , ctxt - > fs ) ;
loadsegment ( gs , ctxt - > gs ) ;
loadsegment ( ss , ctxt - > ss ) ;
2005-04-16 22:20:36 +00:00
/*
* sysenter MSRs
*/
if ( boot_cpu_has ( X86_FEATURE_SEP ) )
2005-06-25 21:54:53 +00:00
enable_sep_cpu ( ) ;
2005-04-16 22:20:36 +00:00
fix_processor_context ( ) ;
do_fpu_end ( ) ;
2005-07-08 00:56:38 +00:00
mtrr_ap_init ( ) ;
2005-11-07 08:58:42 +00:00
mcheck_init ( & boot_cpu_data ) ;
2005-04-16 22:20:36 +00:00
}
void restore_processor_state ( void )
{
__restore_processor_state ( & saved_context ) ;
}
/* Needed by apm.c */
EXPORT_SYMBOL ( save_processor_state ) ;
EXPORT_SYMBOL ( restore_processor_state ) ;