Home Explore Help
Register Sign In
phyus
/
linux-vybrid_public
8
0
Fork 0
Files Issues 0 Pull Requests 0 Wiki
Tree: a2826190aa
Branches Tags
linux-vybrid_pu...
/
arch
/
x86
/
kernel
/
acpi
/
realmode
/
wakeup.S

wakeup.S 1.8 KB
History Raw

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113 
  1. /*
    2. 

  2.  * ACPI wakeup real mode startup stub
    3. 

  3.  */
    4. 

  4. #include <asm/segment.h>
    5. 

  5. #include <asm/msr-index.h>
    6. 

  6. #include <asm/page.h>
    7. 

  7. #include <asm/pgtable.h>
    8. 

  8. 

  9. 	.code16
    10. 

  10. 	.section ".header", "a"
    11. 

  11. 

  12. /* This should match the structure in wakeup.h */
    13. 

  13. 		.globl	wakeup_header
    14. 

  14. wakeup_header:
    15. 

  15. video_mode:	.short	0	/* Video mode number */
    16. 

  16. pmode_return:	.byte	0x66, 0xea	/* ljmpl */
    17. 

  17. 		.long	0	/* offset goes here */
    18. 

  18. 		.short	__KERNEL_CS
    19. 

  19. pmode_cr0:	.long	0	/* Saved %cr0 */
    20. 

  20. pmode_cr3:	.long	0	/* Saved %cr3 */
    21. 

  21. pmode_cr4:	.long	0	/* Saved %cr4 */
    22. 

  22. pmode_efer:	.quad	0	/* Saved EFER */
    23. 

  23. pmode_gdt:	.quad	0
    24. 

  24. realmode_flags:	.long	0
    25. 

  25. real_magic:	.long	0
    26. 

  26. trampoline_segment:	.word 0
    27. 

  27. signature:	.long	0x51ee1111
    28. 

  28. 

  29. 	.text
    30. 

  30. 	.globl	_start
    31. 

  31. 	.code16
    32. 

  32. wakeup_code:
    33. 

  33. _start:
    34. 

  34. 	cli
    35. 

  35. 	cld
    36. 

  36. 

  37. 	/* Set up segments */
    38. 

  38. 	movw	%cs, %ax
    39. 

  39. 	movw	%ax, %ds
    40. 

  40. 	movw	%ax, %es
    41. 

  41. 	movw	%ax, %ss
    42. 

  42. 

  43. 	movl	$wakeup_stack_end, %esp
    44. 

  44. 

  45. 	/* Clear the EFLAGS */
    46. 

  46. 	pushl	$0
    47. 

  47. 	popfl
    48. 

  48. 

  49. 	/* Check header signature... */
    50. 

  50. 	movl	signature, %eax
    51. 

  51. 	cmpl	$0x51ee1111, %eax
    52. 

  52. 	jne	bogus_real_magic
    53. 

  53. 

  54. 	/* Check we really have everything... */
    55. 

  55. 	movl	end_signature, %eax
    56. 

  56. 	cmpl	$0x65a22c82, %eax
    57. 

  57. 	jne	bogus_real_magic
    58. 

  58. 

  59. 	/* Call the C code */
    60. 

  60. 	calll	main
    61. 

  61. 

  62. 	/* Do any other stuff... */
    63. 

  63. 

  64. #ifndef CONFIG_64BIT
    65. 

  65. 	/* This could also be done in C code... */
    66. 

  66. 	movl	pmode_cr3, %eax
    67. 

  67. 	movl	%eax, %cr3
    68. 

  68. 

  69. 	movl	pmode_cr4, %ecx
    70. 

  70. 	jecxz	1f
    71. 

  71. 	movl	%ecx, %cr4
    72. 

  72. 1:
    73. 

  73. 	movl	pmode_efer, %eax
    74. 

  74. 	movl	pmode_efer + 4, %edx
    75. 

  75. 	movl	%eax, %ecx
    76. 

  76. 	orl	%edx, %ecx
    77. 

  77. 	jz	1f
    78. 

  78. 	movl	$0xc0000080, %ecx
    79. 

  79. 	wrmsr
    80. 

  80. 1:
    81. 

  81. 

  82. 	lgdtl	pmode_gdt
    83. 

  83. 

  84. 	/* This really couldn't... */
    85. 

  85. 	movl	pmode_cr0, %eax
    86. 

  86. 	movl	%eax, %cr0
    87. 

  87. 	jmp	pmode_return
    88. 

  88. #else
    89. 

  89. 	pushw	$0
    90. 

  90. 	pushw	trampoline_segment
    91. 

  91. 	pushw	$0
    92. 

  92. 	lret
    93. 

  93. #endif
    94. 

  94. 

  95. bogus_real_magic:
    96. 

  96. 1:
    97. 

  97. 	hlt
    98. 

  98. 	jmp	1b
    99. 

  99. 

  100. 	.data
    101. 

  101. 	.balign	4
    102. 

  102. 	.globl	HEAP, heap_end
    103. 

  103. HEAP:
    104. 

  104. 	.long	wakeup_heap
    105. 

  105. heap_end:
    106. 

  106. 	.long	wakeup_stack
    107. 

  107. 

  108. 	.bss
    109. 

  109. wakeup_heap:
    110. 

  110. 	.space	2048
    111. 

  111. wakeup_stack:
    112. 

  112. 	.space	2048
    113. 

  113. wakeup_stack_end:
    114.