Signed-off-by: jljusten Reviewed-by: mdkinney Reviewed-by: rsun3 Reviewed-by: jyao1 git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@12225 6f19259b-4bc3-4df7-8a09-765794883524
		
			
				
	
	
		
			85 lines
		
	
	
		
			2.3 KiB
		
	
	
	
		
			NASM
		
	
	
	
	
	
			
		
		
	
	
			85 lines
		
	
	
		
			2.3 KiB
		
	
	
	
		
			NASM
		
	
	
	
	
	
| ;; @file
 | |
| ;   This is the assembly code for transferring to control to OS S3 waking vector
 | |
| ;   for X64 platform
 | |
| ;
 | |
| ; Copyright (c) 2006, Intel Corporation. All rights reserved.<BR>
 | |
| ;
 | |
| ; This program and the accompanying materials
 | |
| ; are licensed and made available under the terms and conditions of the BSD License
 | |
| ; which accompanies this distribution.  The full text of the license may be found at
 | |
| ; http://opensource.org/licenses/bsd-license.php
 | |
| ;
 | |
| ; THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
 | |
| ; WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
 | |
| ;
 | |
| ;;
 | |
| 
 | |
|     .code
 | |
|     
 | |
| EXTERNDEF   AsmFixAddress16:DWORD
 | |
| EXTERNDEF   AsmJmpAddr32:DWORD
 | |
|     
 | |
| AsmTransferControl  PROC
 | |
|     ; rcx S3WakingVector    :DWORD
 | |
|     ; rdx AcpiLowMemoryBase :DWORD
 | |
|     lea   eax, @F
 | |
|     mov   r8, 2800000000h
 | |
|     or    rax, r8
 | |
|     push  rax
 | |
|     shrd  ebx, ecx, 20
 | |
|     and   ecx, 0fh          
 | |
|     mov   bx, cx          
 | |
|     mov   @jmp_addr, ebx
 | |
|     retf
 | |
| @@:
 | |
|     DB    0b8h, 30h, 0      ; mov ax, 30h as selector
 | |
|     mov   ds, eax
 | |
|     mov   es, eax
 | |
|     mov   fs, eax
 | |
|     mov   gs, eax
 | |
|     mov   ss, eax
 | |
|     mov   rax, cr0
 | |
|     mov   rbx, cr4        
 | |
|     DB    66h
 | |
|     and   eax, ((NOT 080000001h) AND 0ffffffffh)
 | |
|     and   bl, NOT (1 SHL 5)
 | |
|     mov   cr0, rax
 | |
|     DB    66h
 | |
|     mov   ecx, 0c0000080h
 | |
|     rdmsr
 | |
|     and   ah, NOT 1
 | |
|     wrmsr
 | |
|     mov   cr4, rbx
 | |
|     DB    0eah              ; jmp far @jmp_addr
 | |
| @jmp_addr DD  ?
 | |
| AsmTransferControl  ENDP
 | |
| 
 | |
| AsmTransferControl32  PROC
 | |
|     ; S3WakingVector    :DWORD
 | |
|     ; AcpiLowMemoryBase :DWORD
 | |
|     push  rbp
 | |
|     mov   ebp, esp    
 | |
|     DB    8dh, 05h          ;  lea   eax, AsmTransferControl16
 | |
| AsmFixAddress16  DD ?
 | |
|     push  28h               ; CS
 | |
|     push  rax
 | |
|     retf
 | |
| AsmTransferControl32  ENDP
 | |
| 
 | |
| AsmTransferControl16  PROC
 | |
|     DB    0b8h, 30h, 0      ; mov ax, 30h as selector
 | |
|     mov   ds, ax
 | |
|     mov   es, ax
 | |
|     mov   fs, ax
 | |
|     mov   gs, ax
 | |
|     mov   ss, ax
 | |
|     mov   rax, cr0          ; Get control register 0  
 | |
|     DB    66h
 | |
|     DB    83h, 0e0h, 0feh   ; and    eax, 0fffffffeh  ; Clear PE bit (bit #0)
 | |
|     DB    0fh, 22h, 0c0h    ; mov    cr0, eax         ; Activate real mode
 | |
|     DB    0eah              ; jmp far AsmJmpAddr32
 | |
| AsmJmpAddr32 DD  ?
 | |
| AsmTransferControl16  ENDP
 | |
| 
 | |
|     END
 |