[mirror_edk2.git] / EdkCompatibilityPkg / Foundation / Library / Pei / PeiLib / X64 / ProcessorAsms.Asm

;------------------------------------------------------------------------------\r
;\r
; Copyright (c) 2005 - 2010, Intel Corporation. All rights reserved.<BR>\r
; This program and the accompanying materials                          \r
; are licensed and made available under the terms and conditions of the BSD License         \r
; which accompanies this distribution.  The full text of the license may be found at        \r
; http://opensource.org/licenses/bsd-license.php                                            \r
;                                                                                           \r
; THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,                     \r
; WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.             \r
; \r
; Module Name:\r
;   ProcessorAsms.Asm\r
;\r
; Abstract:\r
;   This is separated from processor.c to allow this functions to be built with /O1\r
;\r
;\r
;------------------------------------------------------------------------------\r
\r
text  SEGMENT\r
\r
\r
;\r
; Routine Description:\r
;   This allows the caller to switch the stack and goes to the new entry point\r
;\r
; Arguments:\r
;   EntryPoint      - Pointer to the location to enter // rcx\r
;   Parameter       - Parameter to pass in             // rdx\r
;   NewStack        - New Location of the stack        // r8\r
;   NewBsp          - New BSP                          // r9 - not used\r
;\r
; Returns:\r
;   Nothing. Goes to the Entry Point passing in the new parameters\r
;\r
SwitchStacks  PROC  PUBLIC\r
\r
    ; Adjust stack for\r
    ;   1) leave 4 registers space\r
    ;   2) let it 16 bytes aligned after call\r
    sub   r8, 20h\r
    and   r8w, 0fff0h    ; do not assume 16 bytes aligned\r
\r
    mov   rsp,  r8       ; rsp = NewStack\r
    mov   r10,  rcx      ; save EntryPoint\r
    mov   rcx,  rdx      ; Arg1 = Parameter\r
    call  r10            ; r10 = copy of EntryPoint\r
 ;\r
 ; no ret as we have a new stack and we jumped to the new location\r
 ;     \r
    ret\r
  \r
SwitchStacks    ENDP\r
\r
\r
EFI_SUCCESS                     equ     0\r
EFI_WARN_RETURN_FROM_LONG_JUMP  equ     5\r
\r
;\r
; Generated by h2inc run manually\r
;\r
_EFI_JUMP_BUFFER                STRUCT 2t\r
_rbx            QWORD           ?\r
_rsp            QWORD           ?\r
_rbp            QWORD           ?\r
_rdi            QWORD           ?\r
_rsi            QWORD           ?\r
_r10            QWORD           ?\r
_r11            QWORD           ?\r
_r12            QWORD           ?\r
_r13            QWORD           ?\r
_r14            QWORD           ?\r
_r15            QWORD           ?\r
_rip            QWORD           ?\r
_MxCsr          DWORD           ?\r
_XmmBuffer      DB              160 DUP (?)\r
_EFI_JUMP_BUFFER                ENDS\r
\r
EFI_JUMP_BUFFER         TYPEDEF         _EFI_JUMP_BUFFER\r
\r
\r
;\r
;Routine Description:\r
;\r
;  This routine implements the x64 variant of the SetJump call.  Its\r
;  responsibility is to store system state information for a possible\r
;  subsequent LongJump.\r
;\r
;Arguments:\r
;\r
;  Pointer to CPU context save buffer.\r
;\r
;Returns:\r
;\r
;  EFI_SUCCESS\r
;\r
; EFI_STATUS\r
; EFIAPI\r
; TransferControlLongJump (\r
;   IN EFI_PEI_TRANSFER_CONTROL_PROTOCOL  *This,\r
;   IN EFI_JUMP_BUFFER                    *Jump\r
;   );\r
;\r
; rcx - *This\r
; rdx - JumpBuffer\r
;\r
PUBLIC  TransferControlSetJump\r
TransferControlSetJump  PROC  \r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._rbx, rbx\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._rsp, rsp\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._rbp, rbp\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._rdi, rdi\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._rsi, rsi\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._r10, r10\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._r11, r11\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._r12, r12\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._r13, r13\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._r14, r14\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._r15, r15\r
  ; save non-volatile fp registers\r
  stmxcsr    (EFI_JUMP_BUFFER PTR [rdx])._MxCsr\r
  lea   rax, (EFI_JUMP_BUFFER PTR [rdx])._XmmBuffer\r
  movdqu [rax], xmm6\r
  movdqu [rax + 10h], xmm7\r
  movdqu [rax + 20h], xmm8\r
  movdqu [rax + 30h], xmm9\r
  movdqu [rax + 40h], xmm10\r
  movdqu [rax + 50h], xmm11\r
  movdqu [rax + 60h], xmm12\r
  movdqu [rax + 70h], xmm13\r
  movdqu [rax + 80h], xmm14\r
  movdqu [rax + 90h], xmm15\r
  mov   rax, QWORD PTR [rsp+0]\r
  mov   (EFI_JUMP_BUFFER PTR [rdx])._rip, rax\r
  mov   rax, EFI_SUCCESS  \r
  ret\r
  \r
TransferControlSetJump      ENDP\r
\r
;\r
; EFI_STATUS\r
; EFIAPI\r
; TransferControlLongJump (\r
;   IN EFI_PEI_TRANSFER_CONTROL_PROTOCOL  *This,  // rcx\r
;   IN EFI_JUMP_BUFFER                    *Jump   // rdx\r
;   );\r
;\r
;\r
PUBLIC  TransferControlLongJump\r
TransferControlLongJump  PROC  \r
  ; load non-volatile fp registers\r
  ldmxcsr    (EFI_JUMP_BUFFER PTR [rdx])._MxCsr\r
  lea   rax, (EFI_JUMP_BUFFER PTR [rdx])._XmmBuffer\r
  movdqu xmm6, [rax]\r
  movdqu xmm7, [rax + 10h]\r
  movdqu xmm8, [rax + 20h]\r
  movdqu xmm9, [rax + 30h]\r
  movdqu xmm10, [rax + 40h]\r
  movdqu xmm11, [rax + 50h]\r
  movdqu xmm12, [rax + 60h]\r
  movdqu xmm13, [rax + 70h]\r
  movdqu xmm14, [rax + 80h]\r
  movdqu xmm15, [rax + 90h]\r
  ; set return from SetJump to EFI_WARN_RETURN_FROM_LONG_JUMP\r
  mov   rax, EFI_WARN_RETURN_FROM_LONG_JUMP          \r
  mov   rbx, (EFI_JUMP_BUFFER PTR [rdx])._rbx\r
  mov   rsp, (EFI_JUMP_BUFFER PTR [rdx])._rsp\r
  mov   rbp, (EFI_JUMP_BUFFER PTR [rdx])._rbp\r
  mov   rdi, (EFI_JUMP_BUFFER PTR [rdx])._rdi\r
  mov   rsi, (EFI_JUMP_BUFFER PTR [rdx])._rsi\r
  mov   r10, (EFI_JUMP_BUFFER PTR [rdx])._r10\r
  mov   r11, (EFI_JUMP_BUFFER PTR [rdx])._r11\r
  mov   r12, (EFI_JUMP_BUFFER PTR [rdx])._r12\r
  mov   r13, (EFI_JUMP_BUFFER PTR [rdx])._r13\r
  mov   r14, (EFI_JUMP_BUFFER PTR [rdx])._r14\r
  mov   r15, (EFI_JUMP_BUFFER PTR [rdx])._r15\r
  add   rsp, 8                                       ;pop the eip\r
  jmp   QWORD PTR (EFI_JUMP_BUFFER PTR [rdx])._rip\r
  ; set return from SetJump to EFI_WARN_RETURN_FROM_LONG_JUMP\r
  mov   rax, EFI_WARN_RETURN_FROM_LONG_JUMP\r
  ret\r
TransferControlLongJump  ENDP\r
\r
text  ENDS\r
END\r
Commit	Line	Data
3eb9473e	1	;------------------------------------------------------------------------------\r
3eb9473e	2	;\r
3e99020d	3	; Copyright (c) 2005 - 2010, Intel Corporation. All rights reserved.<BR>\r
4ea9375a	4	; This program and the accompanying materials \r
3eb9473e	5	; are licensed and made available under the terms and conditions of the BSD License \r
	6	; which accompanies this distribution. The full text of the license may be found at \r
	7	; http://opensource.org/licenses/bsd-license.php \r
	8	; \r
	9	; THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, \r
	10	; WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. \r
	11	; \r
	12	; Module Name:\r
	13	; ProcessorAsms.Asm\r
	14	;\r
	15	; Abstract:\r
	16	; This is separated from processor.c to allow this functions to be built with /O1\r
	17	;\r
	18	;\r
	19	;------------------------------------------------------------------------------\r
	20	\r
	21	text SEGMENT\r
	22	\r
	23	\r
	24	;\r
	25	; Routine Description:\r
	26	; This allows the caller to switch the stack and goes to the new entry point\r
	27	;\r
	28	; Arguments:\r
	29	; EntryPoint - Pointer to the location to enter // rcx\r
	30	; Parameter - Parameter to pass in // rdx\r
	31	; NewStack - New Location of the stack // r8\r
	32	; NewBsp - New BSP // r9 - not used\r
	33	;\r
	34	; Returns:\r
	35	; Nothing. Goes to the Entry Point passing in the new parameters\r
	36	;\r
	37	SwitchStacks PROC PUBLIC\r
	38	\r
	39	; Adjust stack for\r
	40	; 1) leave 4 registers space\r
	41	; 2) let it 16 bytes aligned after call\r
	42	sub r8, 20h\r
	43	and r8w, 0fff0h ; do not assume 16 bytes aligned\r
	44	\r
	45	mov rsp, r8 ; rsp = NewStack\r
	46	mov r10, rcx ; save EntryPoint\r
	47	mov rcx, rdx ; Arg1 = Parameter\r
	48	call r10 ; r10 = copy of EntryPoint\r
	49	;\r
	50	; no ret as we have a new stack and we jumped to the new location\r
	51	; \r
	52	ret\r
	53	\r
	54	SwitchStacks ENDP\r
	55	\r
	56	\r
	57	EFI_SUCCESS equ 0\r
	58	EFI_WARN_RETURN_FROM_LONG_JUMP equ 5\r
	59	\r
	60	;\r
	61	; Generated by h2inc run manually\r
	62	;\r
	63	_EFI_JUMP_BUFFER STRUCT 2t\r
	64	_rbx QWORD ?\r
	65	_rsp QWORD ?\r
	66	_rbp QWORD ?\r
	67	_rdi QWORD ?\r
	68	_rsi QWORD ?\r
69	_r10 QWORD ?\r
70	_r11 QWORD ?\r
71	_r12 QWORD ?\r
72	_r13 QWORD ?\r
73	_r14 QWORD ?\r
74	_r15 QWORD ?\r
75	_rip QWORD ?\r
3e99020d LG	76	_MxCsr DWORD ?\r
3e99020d LG	77	_XmmBuffer DB 160 DUP (?)\r
3eb9473e	78	_EFI_JUMP_BUFFER ENDS\r
	79	\r
	80	EFI_JUMP_BUFFER TYPEDEF _EFI_JUMP_BUFFER\r
	81	\r
	82	\r
	83	;\r
	84	;Routine Description:\r
	85	;\r
	86	; This routine implements the x64 variant of the SetJump call. Its\r
	87	; responsibility is to store system state information for a possible\r
	88	; subsequent LongJump.\r
	89	;\r
	90	;Arguments:\r
	91	;\r
	92	; Pointer to CPU context save buffer.\r
	93	;\r
	94	;Returns:\r
	95	;\r
	96	; EFI_SUCCESS\r
	97	;\r
	98	; EFI_STATUS\r
	99	; EFIAPI\r
	100	; TransferControlLongJump (\r
	101	; IN EFI_PEI_TRANSFER_CONTROL_PROTOCOL *This,\r
	102	; IN EFI_JUMP_BUFFER *Jump\r
	103	; );\r
	104	;\r
	105	; rcx - *This\r
	106	; rdx - JumpBuffer\r
	107	;\r
	108	PUBLIC TransferControlSetJump\r
	109	TransferControlSetJump PROC \r
	110	mov (EFI_JUMP_BUFFER PTR [rdx])._rbx, rbx\r
	111	mov (EFI_JUMP_BUFFER PTR [rdx])._rsp, rsp\r
	112	mov (EFI_JUMP_BUFFER PTR [rdx])._rbp, rbp\r
	113	mov (EFI_JUMP_BUFFER PTR [rdx])._rdi, rdi\r
	114	mov (EFI_JUMP_BUFFER PTR [rdx])._rsi, rsi\r
	115	mov (EFI_JUMP_BUFFER PTR [rdx])._r10, r10\r
	116	mov (EFI_JUMP_BUFFER PTR [rdx])._r11, r11\r
	117	mov (EFI_JUMP_BUFFER PTR [rdx])._r12, r12\r
	118	mov (EFI_JUMP_BUFFER PTR [rdx])._r13, r13\r
	119	mov (EFI_JUMP_BUFFER PTR [rdx])._r14, r14\r
	120	mov (EFI_JUMP_BUFFER PTR [rdx])._r15, r15\r
3e99020d LG	121	; save non-volatile fp registers\r
	122	stmxcsr (EFI_JUMP_BUFFER PTR [rdx])._MxCsr\r
	123	lea rax, (EFI_JUMP_BUFFER PTR [rdx])._XmmBuffer\r
	124	movdqu [rax], xmm6\r
	125	movdqu [rax + 10h], xmm7\r
	126	movdqu [rax + 20h], xmm8\r
	127	movdqu [rax + 30h], xmm9\r
	128	movdqu [rax + 40h], xmm10\r
	129	movdqu [rax + 50h], xmm11\r
	130	movdqu [rax + 60h], xmm12\r
	131	movdqu [rax + 70h], xmm13\r
	132	movdqu [rax + 80h], xmm14\r
	133	movdqu [rax + 90h], xmm15\r
3eb9473e	134	mov rax, QWORD PTR [rsp+0]\r
	135	mov (EFI_JUMP_BUFFER PTR [rdx])._rip, rax\r
	136	mov rax, EFI_SUCCESS \r
	137	ret\r
	138	\r
	139	TransferControlSetJump ENDP\r
	140	\r
	141	;\r
	142	; EFI_STATUS\r
	143	; EFIAPI\r
	144	; TransferControlLongJump (\r
	145	; IN EFI_PEI_TRANSFER_CONTROL_PROTOCOL *This, // rcx\r
	146	; IN EFI_JUMP_BUFFER *Jump // rdx\r
	147	; );\r
	148	;\r
	149	;\r
	150	PUBLIC TransferControlLongJump\r
	151	TransferControlLongJump PROC \r
3e99020d LG	152	; load non-volatile fp registers\r
	153	ldmxcsr (EFI_JUMP_BUFFER PTR [rdx])._MxCsr\r
	154	lea rax, (EFI_JUMP_BUFFER PTR [rdx])._XmmBuffer\r
	155	movdqu xmm6, [rax]\r
	156	movdqu xmm7, [rax + 10h]\r
	157	movdqu xmm8, [rax + 20h]\r
	158	movdqu xmm9, [rax + 30h]\r
	159	movdqu xmm10, [rax + 40h]\r
	160	movdqu xmm11, [rax + 50h]\r
	161	movdqu xmm12, [rax + 60h]\r
	162	movdqu xmm13, [rax + 70h]\r
	163	movdqu xmm14, [rax + 80h]\r
	164	movdqu xmm15, [rax + 90h]\r
3eb9473e	165	; set return from SetJump to EFI_WARN_RETURN_FROM_LONG_JUMP\r
	166	mov rax, EFI_WARN_RETURN_FROM_LONG_JUMP \r
	167	mov rbx, (EFI_JUMP_BUFFER PTR [rdx])._rbx\r
	168	mov rsp, (EFI_JUMP_BUFFER PTR [rdx])._rsp\r
	169	mov rbp, (EFI_JUMP_BUFFER PTR [rdx])._rbp\r
	170	mov rdi, (EFI_JUMP_BUFFER PTR [rdx])._rdi\r
	171	mov rsi, (EFI_JUMP_BUFFER PTR [rdx])._rsi\r
	172	mov r10, (EFI_JUMP_BUFFER PTR [rdx])._r10\r
	173	mov r11, (EFI_JUMP_BUFFER PTR [rdx])._r11\r
	174	mov r12, (EFI_JUMP_BUFFER PTR [rdx])._r12\r
	175	mov r13, (EFI_JUMP_BUFFER PTR [rdx])._r13\r
	176	mov r14, (EFI_JUMP_BUFFER PTR [rdx])._r14\r
	177	mov r15, (EFI_JUMP_BUFFER PTR [rdx])._r15\r
	178	add rsp, 8 ;pop the eip\r
	179	jmp QWORD PTR (EFI_JUMP_BUFFER PTR [rdx])._rip\r
	180	; set return from SetJump to EFI_WARN_RETURN_FROM_LONG_JUMP\r
	181	mov rax, EFI_WARN_RETURN_FROM_LONG_JUMP\r
	182	ret\r
	183	TransferControlLongJump ENDP\r
	184	\r
	185	text ENDS\r
	186	END\r