1. Updated SetJump() and LongJump() for IPF

2. Added assertion for SetJump() for all architectures
3. Added CpuSleep() for IPF

git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@464 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
bxing 2006-06-10 07:16:11 +00:00
parent 8b4e96c42b
commit 4cbd217532
17 changed files with 511 additions and 471 deletions

View File

@ -45,65 +45,44 @@ typedef struct {
// IPF context buffer used by SetJump() and LongJump() // IPF context buffer used by SetJump() and LongJump()
// //
typedef struct { typedef struct {
UINT64 InitialUNAT; UINT64 F2[2];
UINT64 AfterSpillUNAT; UINT64 F3[2];
UINT64 PFS; UINT64 F4[2];
UINT64 BSP; UINT64 F5[2];
UINT64 RNAT; UINT64 F16[2];
UINT64 Predicates; UINT64 F17[2];
UINT64 LoopCount; UINT64 F18[2];
UINT64 F19[2];
UINT64 F20[2];
UINT64 F21[2];
UINT64 F22[2];
UINT64 F23[2];
UINT64 F24[2];
UINT64 F25[2];
UINT64 F26[2];
UINT64 F27[2];
UINT64 F28[2];
UINT64 F29[2];
UINT64 F30[2];
UINT64 F31[2];
UINT64 R4; UINT64 R4;
UINT64 R5; UINT64 R5;
UINT64 R6; UINT64 R6;
UINT64 R7; UINT64 R7;
UINT64 SP; UINT64 SP;
UINT64 F2Low;
UINT64 F2High;
UINT64 F3Low;
UINT64 F3High;
UINT64 F4Low;
UINT64 F4High;
UINT64 F5Low;
UINT64 F5High;
UINT64 F16Low;
UINT64 F16High;
UINT64 F17Low;
UINT64 F17High;
UINT64 F18Low;
UINT64 F18High;
UINT64 F19Low;
UINT64 F19High;
UINT64 F20Low;
UINT64 F20High;
UINT64 F21Low;
UINT64 F21High;
UINT64 F22Low;
UINT64 F22High;
UINT64 F23Low;
UINT64 F23High;
UINT64 F24Low;
UINT64 F24High;
UINT64 F25Low;
UINT64 F25High;
UINT64 F26Low;
UINT64 F26High;
UINT64 F27Low;
UINT64 F27High;
UINT64 F28Low;
UINT64 F28High;
UINT64 F29Low;
UINT64 F29High;
UINT64 F30Low;
UINT64 F30High;
UINT64 F31Low;
UINT64 F31High;
UINT64 FPSR;
UINT64 BR0; UINT64 BR0;
UINT64 BR1; UINT64 BR1;
UINT64 BR2; UINT64 BR2;
UINT64 BR3; UINT64 BR3;
UINT64 BR4; UINT64 BR4;
UINT64 BR5; UINT64 BR5;
UINT64 InitialUNAT;
UINT64 AfterSpillUNAT;
UINT64 PFS;
UINT64 BSP;
UINT64 Predicates;
UINT64 LoopCount;
UINT64 FPSR;
} BASE_LIBRARY_JUMP_BUFFER; } BASE_LIBRARY_JUMP_BUFFER;
#elif defined (MDE_CPU_X64) #elif defined (MDE_CPU_X64)
@ -2866,6 +2845,7 @@ typedef union {
// //
// Byte packed structure for an IDTR, GDTR, LDTR descriptor // Byte packed structure for an IDTR, GDTR, LDTR descriptor
/// @bug How to make this structure byte-packed in a compiler independent way?
// //
typedef struct { typedef struct {
UINT16 Limit; UINT16 Limit;

View File

@ -36,6 +36,7 @@ WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
<LibraryClass Usage="ALWAYS_CONSUMED">BaseMemoryLib</LibraryClass> <LibraryClass Usage="ALWAYS_CONSUMED">BaseMemoryLib</LibraryClass>
<LibraryClass Usage="ALWAYS_CONSUMED">DebugLib</LibraryClass> <LibraryClass Usage="ALWAYS_CONSUMED">DebugLib</LibraryClass>
<LibraryClass Usage="ALWAYS_CONSUMED">TimerLib</LibraryClass> <LibraryClass Usage="ALWAYS_CONSUMED">TimerLib</LibraryClass>
<LibraryClass Usage="ALWAYS_CONSUMED">PcdLib</LibraryClass>
</LibraryClassDefinitions> </LibraryClassDefinitions>
<SourceFiles> <SourceFiles>
<Filename>String.c</Filename> <Filename>String.c</Filename>
@ -65,15 +66,16 @@ WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
<Filename>RRotU32.c</Filename> <Filename>RRotU32.c</Filename>
<Filename>RRotU64.c</Filename> <Filename>RRotU64.c</Filename>
<Filename>RShiftU64.c</Filename> <Filename>RShiftU64.c</Filename>
<Filename>SetJump.c</Filename>
<Filename>LongJump.c</Filename>
<Filename>SwapBytes16.c</Filename> <Filename>SwapBytes16.c</Filename>
<Filename>SwapBytes32.c</Filename> <Filename>SwapBytes32.c</Filename>
<Filename>SwapBytes64.c</Filename> <Filename>SwapBytes64.c</Filename>
<Filename>SwitchStack.c</Filename>
<Arch ArchType="IA32"> <Arch ArchType="IA32">
<Filename>x86LowLevel.c</Filename> <Filename>x86LowLevel.c</Filename>
<Filename>x86Thunk.c</Filename> <Filename>x86Thunk.c</Filename>
<Filename>Unaligned.c</Filename> <Filename>Unaligned.c</Filename>
<Filename>LongJump.c</Filename>
<Filename>SwitchStack.c</Filename>
<Filename>Ia32/Non-existing.c</Filename> <Filename>Ia32/Non-existing.c</Filename>
<Filename>Ia32/InternalSwitchStack.c</Filename> <Filename>Ia32/InternalSwitchStack.c</Filename>
<Filename>Ia32/LShiftU64.asm</Filename> <Filename>Ia32/LShiftU64.asm</Filename>
@ -175,104 +177,102 @@ WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
<Filename>Ia32/Thunk16.asm</Filename> <Filename>Ia32/Thunk16.asm</Filename>
</Arch> </Arch>
<Arch ArchType="X64"> <Arch ArchType="X64">
<Filename>x86LowLevel.c</Filename> <Filename>X86LowLevel.c</Filename>
<Filename>x86Thunk.c</Filename> <Filename>X86Thunk.c</Filename>
<Filename>Unaligned.c</Filename> <Filename>Unaligned.c</Filename>
<Filename>Math64.c</Filename> <Filename>Math64.c</Filename>
<Filename>LongJump.c</Filename> <Filename>X64/Non-existing.c</Filename>
<Filename>SwitchStack.c</Filename> <Filename>X64/SwitchStack.asm</Filename>
<Filename>x64/Non-existing.c</Filename> <Filename>X64/SetJump.asm</Filename>
<Filename>x64/SwitchStack.asm</Filename> <Filename>X64/LongJump.asm</Filename>
<Filename>x64/SetJump.asm</Filename> <Filename>X64/CpuId.asm</Filename>
<Filename>x64/LongJump.asm</Filename> <Filename>X64/CpuIdEx.asm</Filename>
<Filename>x64/CpuId.asm</Filename> <Filename>X64/ReadEflags.asm</Filename>
<Filename>x64/ReadEflags.asm</Filename> <Filename>X64/ReadMsr32.asm</Filename>
<Filename>x64/ReadMsr32.asm</Filename> <Filename>X64/ReadMsr64.asm</Filename>
<Filename>x64/ReadMsr64.asm</Filename> <Filename>X64/WriteMsr32.asm</Filename>
<Filename>x64/WriteMsr32.asm</Filename> <Filename>X64/WriteMsr64.asm</Filename>
<Filename>x64/WriteMsr64.asm</Filename> <Filename>X64/ReadCr0.asm</Filename>
<Filename>x64/ReadCr0.asm</Filename> <Filename>X64/ReadCr2.asm</Filename>
<Filename>x64/ReadCr2.asm</Filename> <Filename>X64/ReadCr3.asm</Filename>
<Filename>x64/ReadCr3.asm</Filename> <Filename>X64/ReadCr4.asm</Filename>
<Filename>x64/ReadCr4.asm</Filename> <Filename>X64/WriteCr0.asm</Filename>
<Filename>x64/WriteCr0.asm</Filename> <Filename>X64/WriteCr2.asm</Filename>
<Filename>x64/WriteCr2.asm</Filename> <Filename>X64/WriteCr3.asm</Filename>
<Filename>x64/WriteCr3.asm</Filename> <Filename>X64/WriteCr4.asm</Filename>
<Filename>x64/WriteCr4.asm</Filename> <Filename>X64/ReadDr0.asm</Filename>
<Filename>x64/ReadDr0.asm</Filename> <Filename>X64/ReadDr1.asm</Filename>
<Filename>x64/ReadDr1.asm</Filename> <Filename>X64/ReadDr2.asm</Filename>
<Filename>x64/ReadDr2.asm</Filename> <Filename>X64/ReadDr3.asm</Filename>
<Filename>x64/ReadDr3.asm</Filename> <Filename>X64/ReadDr4.asm</Filename>
<Filename>x64/ReadDr4.asm</Filename> <Filename>X64/ReadDr5.asm</Filename>
<Filename>x64/ReadDr5.asm</Filename> <Filename>X64/ReadDr6.asm</Filename>
<Filename>x64/ReadDr6.asm</Filename> <Filename>X64/ReadDr7.asm</Filename>
<Filename>x64/ReadDr7.asm</Filename> <Filename>X64/WriteDr0.asm</Filename>
<Filename>x64/WriteDr0.asm</Filename> <Filename>X64/WriteDr1.asm</Filename>
<Filename>x64/WriteDr1.asm</Filename> <Filename>X64/WriteDr2.asm</Filename>
<Filename>x64/WriteDr2.asm</Filename> <Filename>X64/WriteDr3.asm</Filename>
<Filename>x64/WriteDr3.asm</Filename> <Filename>X64/WriteDr4.asm</Filename>
<Filename>x64/WriteDr4.asm</Filename> <Filename>X64/WriteDr5.asm</Filename>
<Filename>x64/WriteDr5.asm</Filename> <Filename>X64/WriteDr6.asm</Filename>
<Filename>x64/WriteDr6.asm</Filename> <Filename>X64/WriteDr7.asm</Filename>
<Filename>x64/WriteDr7.asm</Filename> <Filename>X64/ReadCs.asm</Filename>
<Filename>x64/ReadCs.asm</Filename> <Filename>X64/ReadDs.asm</Filename>
<Filename>x64/ReadDs.asm</Filename> <Filename>X64/ReadEs.asm</Filename>
<Filename>x64/ReadEs.asm</Filename> <Filename>X64/ReadFs.asm</Filename>
<Filename>x64/ReadFs.asm</Filename> <Filename>X64/ReadGs.asm</Filename>
<Filename>x64/ReadGs.asm</Filename> <Filename>X64/ReadSs.asm</Filename>
<Filename>x64/ReadSs.asm</Filename> <Filename>X64/ReadTr.asm</Filename>
<Filename>x64/ReadTr.asm</Filename> <Filename>X64/ReadGdtr.asm</Filename>
<Filename>x64/ReadGdtr.asm</Filename> <Filename>X64/WriteGdtr.asm</Filename>
<Filename>x64/WriteGdtr.asm</Filename> <Filename>X64/ReadIdtr.asm</Filename>
<Filename>x64/ReadIdtr.asm</Filename> <Filename>X64/WriteIdtr.asm</Filename>
<Filename>x64/WriteIdtr.asm</Filename> <Filename>X64/ReadLdtr.asm</Filename>
<Filename>x64/ReadLdtr.asm</Filename> <Filename>X64/WriteLdtr.asm</Filename>
<Filename>x64/WriteLdtr.asm</Filename> <Filename>X64/FxSave.asm</Filename>
<Filename>x64/FxSave.asm</Filename> <Filename>X64/FxRestore.asm</Filename>
<Filename>x64/FxRestore.asm</Filename> <Filename>X64/ReadMm0.asm</Filename>
<Filename>x64/ReadMm0.asm</Filename> <Filename>X64/ReadMm1.asm</Filename>
<Filename>x64/ReadMm1.asm</Filename> <Filename>X64/ReadMm2.asm</Filename>
<Filename>x64/ReadMm2.asm</Filename> <Filename>X64/ReadMm3.asm</Filename>
<Filename>x64/ReadMm3.asm</Filename> <Filename>X64/ReadMm4.asm</Filename>
<Filename>x64/ReadMm4.asm</Filename> <Filename>X64/ReadMm5.asm</Filename>
<Filename>x64/ReadMm5.asm</Filename> <Filename>X64/ReadMm6.asm</Filename>
<Filename>x64/ReadMm6.asm</Filename> <Filename>X64/ReadMm7.asm</Filename>
<Filename>x64/ReadMm7.asm</Filename> <Filename>X64/WriteMm0.asm</Filename>
<Filename>x64/WriteMm0.asm</Filename> <Filename>X64/WriteMm1.asm</Filename>
<Filename>x64/WriteMm1.asm</Filename> <Filename>X64/WriteMm2.asm</Filename>
<Filename>x64/WriteMm2.asm</Filename> <Filename>X64/WriteMm3.asm</Filename>
<Filename>x64/WriteMm3.asm</Filename> <Filename>X64/WriteMm4.asm</Filename>
<Filename>x64/WriteMm4.asm</Filename> <Filename>X64/WriteMm5.asm</Filename>
<Filename>x64/WriteMm5.asm</Filename> <Filename>X64/WriteMm6.asm</Filename>
<Filename>x64/WriteMm6.asm</Filename> <Filename>X64/WriteMm7.asm</Filename>
<Filename>x64/WriteMm7.asm</Filename> <Filename>X64/ReadTsc.asm</Filename>
<Filename>x64/ReadTsc.asm</Filename> <Filename>X64/ReadPmc.asm</Filename>
<Filename>x64/ReadPmc.asm</Filename> <Filename>X64/Monitor.asm</Filename>
<Filename>x64/Monitor.asm</Filename> <Filename>X64/Mwait.asm</Filename>
<Filename>x64/Mwait.asm</Filename> <Filename>X64/DisablePaging64.asm</Filename>
<Filename>x64/DisablePaging64.asm</Filename> <Filename>X64/Wbinvd.asm</Filename>
<Filename>x64/Wbinvd.asm</Filename> <Filename>X64/Invd.asm</Filename>
<Filename>x64/Invd.asm</Filename> <Filename>X64/FlushCacheLine.asm</Filename>
<Filename>x64/FlushCacheLine.asm</Filename> <Filename>X64/InterlockedIncrement.asm</Filename>
<Filename>x64/InterlockedIncrement.asm</Filename> <Filename>X64/InterlockedDecrement.asm</Filename>
<Filename>x64/InterlockedDecrement.asm</Filename> <Filename>X64/InterlockedCompareExchange32.asm</Filename>
<Filename>x64/InterlockedCompareExchange32.asm</Filename> <Filename>X64/InterlockedCompareExchange64.asm</Filename>
<Filename>x64/InterlockedCompareExchange64.asm</Filename> <Filename>X64/EnableInterrupts.asm</Filename>
<Filename>x64/EnableInterrupts.asm</Filename> <Filename>X64/DisableInterrupts.asm</Filename>
<Filename>x64/DisableInterrupts.asm</Filename> <Filename>X64/EnableDisableInterrupts.asm</Filename>
<Filename>x64/EnableDisableInterrupts.asm</Filename> <Filename>X64/CpuSleep.asm</Filename>
<Filename>x64/CpuSleep.asm</Filename> <Filename>X64/CpuPause.asm</Filename>
<Filename>x64/CpuPause.asm</Filename> <Filename>X64/CpuBreakpoint.asm</Filename>
<Filename>x64/CpuBreakpoint.asm</Filename> <Filename>X64/CpuFlushTlb.asm</Filename>
<Filename>x64/CpuFlushTlb.asm</Filename> <Filename>X64/Thunk16.asm</Filename>
<Filename>x64/Thunk16.asm</Filename>
</Arch> </Arch>
<Arch ArchType="IPF"> <Arch ArchType="IPF">
<Filename>Math64.c</Filename> <Filename>Math64.c</Filename>
<Filename>LongJump.c</Filename>
<Filename>SwitchStack.c</Filename>
<Filename>Ipf/PalCallStatic.s</Filename> <Filename>Ipf/PalCallStatic.s</Filename>
<Filename>Ipf/setjmp.s</Filename> <Filename>Ipf/setjmp.s</Filename>
<Filename>Ipf/longjmp.s</Filename>
<Filename>Ipf/SwitchStack.s</Filename> <Filename>Ipf/SwitchStack.s</Filename>
<Filename>Ipf/Unaligned.c</Filename> <Filename>Ipf/Unaligned.c</Filename>
<Filename>Ipf/CpuBreakpoint.c</Filename> <Filename>Ipf/CpuBreakpoint.c</Filename>

View File

@ -1,5 +1,5 @@
/** @file /** @file
Switch Stack functions. Switch Stack functions.
Copyright (c) 2006, Intel Corporation Copyright (c) 2006, Intel Corporation
All rights reserved. This program and the accompanying materials All rights reserved. This program and the accompanying materials
@ -14,27 +14,28 @@
**/ **/
VOID
EFIAPI
InternalAssertJumpBuffer (
IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer
);
UINTN UINTN
EFIAPI EFIAPI
SetJump ( SetJump (
IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer
) )
{ {
ASSERT (JumpBuffer != NULL); InternalAssertJumpBuffer (JumpBuffer);
ASSERT (FALSE);
return 0; return 0;
} }
VOID VOID
EFIAPI EFIAPI
LongJump ( InternalLongJump (
IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer, IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer,
IN UINTN Value IN UINTN Value
) )
{ {
ASSERT (JumpBuffer != NULL);
ASSERT (Value != 0);
ASSERT (FALSE); ASSERT (FALSE);
} }

View File

@ -36,7 +36,7 @@
**/ **/
VOID VOID
EFIAPI EFIAPI
SwitchStack ( InternalSwitchStack (
IN SWITCH_STACK_ENTRY_POINT EntryPoint, IN SWITCH_STACK_ENTRY_POINT EntryPoint,
IN VOID *Context1, OPTIONAL IN VOID *Context1, OPTIONAL
IN VOID *Context2, OPTIONAL IN VOID *Context2, OPTIONAL

View File

@ -20,10 +20,10 @@
;------------------------------------------------------------------------------ ;------------------------------------------------------------------------------
.386 .386
.model flat .model flat,C
.code .code
__LongJump PROC IntenralLongJump PROC
pop eax pop eax
pop edx pop edx
pop eax pop eax
@ -33,6 +33,6 @@ __LongJump PROC
mov ebp, [edx + 12] mov ebp, [edx + 12]
mov esp, [edx + 16] mov esp, [edx + 16]
jmp dword ptr [edx + 20] jmp dword ptr [edx + 20]
__LongJump ENDP IntenralLongJump ENDP
END END

View File

@ -20,10 +20,15 @@
;------------------------------------------------------------------------------ ;------------------------------------------------------------------------------
.386 .386
.model flat .model flat,C
.code .code
_SetJump PROC InternalAssertJumpBuffer PROTO C
SetJump PROC
push [esp + 4]
call InternalAssertJumpBuffer
pop ecx
pop ecx pop ecx
mov edx, [esp] mov edx, [esp]
mov [edx], ebx mov [edx], ebx
@ -34,6 +39,6 @@ _SetJump PROC
mov [edx + 20], ecx mov [edx + 20], ecx
xor eax, eax xor eax, eax
jmp ecx jmp ecx
_SetJump ENDP SetJump ENDP
END END

View File

@ -19,6 +19,22 @@
#pragma intrinsic (__break) #pragma intrinsic (__break)
#pragma intrinsic (__mfa) #pragma intrinsic (__mfa)
typedef struct {
UINT64 Status;
UINT64 r9;
UINT64 r10;
UINT64 r11;
} PAL_PROC_RETURN;
PAL_PROC_RETURN
PalCallStatic (
IN CONST VOID *PalEntryPoint,
IN UINT64 Arg1,
IN UINT64 Arg2,
IN UINT64 Arg3,
IN UINT64 Arg4
);
/** /**
Generates a breakpoint on the CPU. Generates a breakpoint on the CPU.
@ -117,3 +133,20 @@ EnableDisableInterrupts (
EnableInterrupts (); EnableInterrupts ();
DisableInterrupts (); DisableInterrupts ();
} }
/**
Places the CPU in a sleep state until an interrupt is received.
Places the CPU in a sleep state until an interrupt is received. If interrupts
are disabled prior to calling this function, then the CPU will be placed in a
sleep state indefinitely.
**/
VOID
EFIAPI
CpuSleep (
VOID
)
{
PalCallStatic (NULL, 29, 0, 0, 0);
}

View File

@ -23,20 +23,21 @@
.proc CpuFlushTlb .proc CpuFlushTlb
.type CpuFlushTlb, @function .type CpuFlushTlb, @function
CpuFlushTlb:: CpuFlushTlb::
alloc loc0 = ar.pfs, 0, 2, 5, 0 alloc loc0 = ar.pfs, 0, 3, 5, 0
mov out0 = 0 mov out0 = 0
mov out1 = 6 mov out1 = 6
mov out2 = 0 mov out2 = 0
mov out3 = 0 mov out3 = 0
mov out4 = 0
mov loc1 = b0 mov loc1 = b0
br.call.sptk b0 = PalCallStatic mov out4 = 0
rsm 1 << 14 // Disable interrupts brl.call.sptk b0 = PalCallStatic
mov loc2 = psr // save PSR
mov ar.pfs = loc0 mov ar.pfs = loc0
extr.u r14 = r10, 32, 32 // r14 <- count1 extr.u r14 = r10, 32, 32 // r14 <- count1
rsm 1 << 14 // Disable interrupts
extr.u r15 = r11, 32, 32 // r15 <- stride1 extr.u r15 = r11, 32, 32 // r15 <- stride1
extr.u r10 = r10, 0, 32 // r10 <- count2 extr.u r10 = r10, 0, 32 // r10 <- count2
mov loc0 = psr add r10 = -1, r10
extr.u r11 = r11, 0, 32 // r11 <- stride2 extr.u r11 = r11, 0, 32 // r11 <- stride2
br.cond.sptk LoopPredicate br.cond.sptk LoopPredicate
LoopOuter: LoopOuter:
@ -48,10 +49,10 @@ Loop:
br.ctop.sptk Loop br.ctop.sptk Loop
add r9 = r15, r9 // r9 += stride1 add r9 = r15, r9 // r9 += stride1
LoopPredicate: LoopPredicate:
cmp.ne p6, p7 = r0, r14 // count1 == 0? cmp.ne p6 = r0, r14 // count1 == 0?
add r14 = -1, r14 add r14 = -1, r14
(p6) br.cond.sptk LoopOuter (p6) br.cond.sptk LoopOuter
mov psr.l = loc0 mov psr.l = loc2
mov b0 = loc1 mov b0 = loc1
br.ret.sptk.many b0 br.ret.sptk.many b0
.endp .endp

View File

@ -22,7 +22,7 @@
.type PalCallStatic, @function .type PalCallStatic, @function
.regstk 5, 0, 0, 0 .regstk 5, 0, 0, 0
PalCallStatic:: PalCallStatic::
cmp.ne p6, p7 = r0, in0 cmp.eq p6 = r0, in0
mov r31 = in4 mov r31 = in4
mov r8 = ip mov r8 = ip
(p6) mov in0 = ar.k5 (p6) mov in0 = ar.k5
@ -39,8 +39,9 @@ PalCallStatic::
br.cond.sptk b7 br.cond.sptk b7
PalProcReturn: PalProcReturn:
mov psr.l = in3 mov psr.l = in3
cmp.eq p6, p7 = in0, in1 // in1 == PAL_COPY_PAL? cmp.eq p6 = in0, in1 // in1 == PAL_COPY_PAL?
(p6) cmp.eq p6, p7 = r0, r8 // Status == Success? (p6) cmp.eq p6 = r0, r8 // Status == Success?
(p6) add in2 = r9, in2
(p6) mov ar.k5 = in2 (p6) mov ar.k5 = in2
mov b0 = in4 mov b0 = in4
br.ret.sptk.many b0 br.ret.sptk.many b0

View File

@ -0,0 +1,121 @@
/// @file
/// Contains an implementation of longjmp for the Itanium-based architecture.
///
/// Copyright (c) 2006, Intel Corporation
/// All rights reserved. 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.
///
/// Module Name: longjmp.s
///
///
.auto
.text
.proc InternalLongJump
.type InternalLongJump, @function
.regstk 2, 0, 0, 0
InternalLongJump::
add r10 = 0x10*20 + 8*14, in0
movl r2 = ~((((1 << 14) - 1) << 16) | 3)
ld8.nt1 r14 = [r10], -8*2 // BSP, skip PFS
mov r15 = ar.bspstore // BSPSTORE
ld8.nt1 r17 = [r10], -8 // UNAT after spill
mov r16 = ar.rsc // RSC
cmp.leu p6 = r14, r15
ld8.nt1 r18 = [r10], -8 // UNAT
ld8.nt1 r25 = [r10], -8 // b5
and r2 = r16, r2
ldf.fill.nt1 f2 = [in0], 0x10
ld8.nt1 r24 = [r10], -8 // b4
mov b5 = r25
mov ar.rsc = r2
ld8.nt1 r23 = [r10], -8 // b3
mov b4 = r24
ldf.fill.nt1 f3 = [in0], 0x10
mov ar.unat = r17
(p6) br.spnt.many _skip_flushrs
flushrs
mov r15 = ar.bsp // New BSPSTORE
_skip_flushrs:
mov r31 = ar.rnat // RNAT
loadrs
ldf.fill.nt1 f4 = [in0], 0x10
ld8.nt1 r22 = [r10], -8
dep r2 = -1, r14, 3, 6
ldf.fill.nt1 f5 = [in0], 0x10
ld8.nt1 r21 = [r10], -8
cmp.ltu p6 = r2, r15
ld8.nt1 r20 = [r10], -0x10 // skip sp
(p6) ld8.nta r31 = [r2]
mov b3 = r23
ldf.fill.nt1 f16 = [in0], 0x10
ld8.fill.nt1 r7 = [r10], -8
mov b2 = r22
ldf.fill.nt1 f17 = [in0], 0x10
ld8.fill.nt1 r6 = [r10], -8
mov b1 = r21
ldf.fill.nt1 f18 = [in0], 0x10
ld8.fill.nt1 r5 = [r10], -8
mov b0 = r20
ldf.fill.nt1 f19 = [in0], 0x10
ld8.fill.nt1 r4 = [r10], 8*13
ldf.fill.nt1 f20 = [in0], 0x10
ld8.nt1 r19 = [r10], 0x10 // PFS
ldf.fill.nt1 f21 = [in0], 0x10
ld8.nt1 r26 = [r10], 8 // Predicate
mov ar.pfs = r19
ldf.fill.nt1 f22 = [in0], 0x10
ld8.nt1 r27 = [r10], 8 // LC
mov pr = r26, -1
ldf.fill.nt1 f23 = [in0], 0x10
ld8.nt1 r28 = [r10], -17*8 - 0x10
mov ar.lc = r27
ldf.fill.nt1 f24 = [in0], 0x10
ldf.fill.nt1 f25 = [in0], 0x10
mov r8 = in1
ldf.fill.nt1 f26 = [in0], 0x10
ldf.fill.nt1 f31 = [r10], -0x10
ldf.fill.nt1 f27 = [in0], 0x10
ldf.fill.nt1 f30 = [r10], -0x10
ldf.fill.nt1 f28 = [in0]
ldf.fill.nt1 f29 = [r10], 0x10*3 + 8*4
ld8.fill.nt1 sp = [r10]
mov ar.unat = r18
mov ar.bspstore = r14
mov ar.rnat = r31
invala
mov ar.rsc = r16
br.ret.sptk b0
.endp

View File

@ -1,317 +1,108 @@
/// @file /// @file
/// Contains an implementation of setjmp and longjmp for the /// Contains an implementation of longjmp for the Itanium-based architecture.
/// Itanium-based architecture.
/// ///
/// Copyright (c) 2006, Intel Corporation /// Copyright (c) 2006, Intel Corporation
/// All rights reserved. This program and the accompanying materials /// All rights reserved. This program and the accompanying materials
/// are licensed and made available under the terms and conditions of the BSD License /// 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 /// which accompanies this distribution. The full text of the license may be found at
/// http://opensource.org/licenses/bsd-license.php /// http://opensource.org/licenses/bsd-license.php
/// ///
/// THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, /// THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
/// WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. /// WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
/// ///
/// Module Name: setjmp.s /// Module Name: longjmp.s
/// ///
/// ///
.file "setjmp.s" .auto
.text
#include "asm.h" .global InternalAssertJumpBuffer
#include "ia_64gen.h" .type InternalAssertJumpBuffer, @function
/// int SetJump(struct jmp_buffer save) .proc SetJump
/// .type SetJump, @function
/// Setup a non-local goto. SetJump::
/// alloc loc0 = ar.pfs, 1, 2, 1, 0
/// Description: mov loc1 = b0
/// mov out0 = in0
/// SetJump stores the current register set in the area pointed to
/// by "save". It returns zero. Subsequent calls to "LongJump" will
/// restore the registers and return non-zero to the same location.
///
/// On entry, r32 contains the pointer to the jmp_buffer
///
PROCEDURE_ENTRY(SetJump) brl.call.sptk.many b0 = InternalAssertJumpBuffer
//
// Make sure buffer is aligned at 16byte boundary
//
mov r32 = r33
add r10 = -0x10,r0 ;; // mask the lower 4 bits mov r14 = ar.unat
and r32 = r32, r10;; mov r15 = ar.bsp
add r32 = 0x10, r32;; // move to next 16 byte boundary add r10 = 0x10*20, in0
add r10 = J_PREDS, r32 // skip Unats & pfs save area stf.spill.nta [in0] = f2, 0x10
add r11 = J_BSP, r32 st8.spill.nta [r10] = r4, 8
// mov r21 = b1
// save immediate context
//
mov r2 = ar.bsp // save backing store pointer
mov r3 = pr // save predicates
;;
//
// save user Unat register
//
mov r16 = ar.lc // save loop count register
mov r14 = ar.unat // save user Unat register
st8 [r10] = r3, J_LC-J_PREDS stf.spill.nta [in0] = f3, 0x10
st8 [r11] = r2, J_R4-J_BSP st8.spill.nta [r10] = r5, 8
;; mov r22 = b2
st8 [r10] = r16, J_R5-J_LC
st8 [r32] = r14, J_NATS // Note: Unat at the
// beginning of the save area
mov r15 = ar.pfs
;;
//
// save preserved general registers & NaT's
//
st8.spill [r11] = r4, J_R6-J_R4
;;
st8.spill [r10] = r5, J_R7-J_R5
;;
st8.spill [r11] = r6, J_SP-J_R6
;;
st8.spill [r10] = r7, J_F3-J_R7
;;
st8.spill [r11] = sp, J_F2-J_SP
;;
//
// save spilled Unat and pfs registers
//
mov r2 = ar.unat // save Unat register after spill
;;
st8 [r32] = r2, J_PFS-J_NATS // save unat for spilled regs
;;
st8 [r32] = r15 // save pfs
//
// save floating registers
//
stf.spill [r11] = f2, J_F4-J_F2
stf.spill [r10] = f3, J_F5-J_F3
;;
stf.spill [r11] = f4, J_F16-J_F4
stf.spill [r10] = f5, J_F17-J_F5
;;
stf.spill [r11] = f16, J_F18-J_F16
stf.spill [r10] = f17, J_F19-J_F17
;;
stf.spill [r11] = f18, J_F20-J_F18
stf.spill [r10] = f19, J_F21-J_F19
;;
stf.spill [r11] = f20, J_F22-J_F20
stf.spill [r10] = f21, J_F23-J_F21
;;
stf.spill [r11] = f22, J_F24-J_F22
stf.spill [r10] = f23, J_F25-J_F23
;;
stf.spill [r11] = f24, J_F26-J_F24
stf.spill [r10] = f25, J_F27-J_F25
;;
stf.spill [r11] = f26, J_F28-J_F26
stf.spill [r10] = f27, J_F29-J_F27
;;
stf.spill [r11] = f28, J_F30-J_F28
stf.spill [r10] = f29, J_F31-J_F29
;;
stf.spill [r11] = f30, J_FPSR-J_F30
stf.spill [r10] = f31, J_B0-J_F31 // size of f31 + fpsr
//
// save FPSR register & branch registers
//
mov r2 = ar.fpsr // save fpsr register
mov r3 = b0
;;
st8 [r11] = r2, J_B1-J_FPSR
st8 [r10] = r3, J_B2-J_B0
mov r2 = b1
mov r3 = b2
;;
st8 [r11] = r2, J_B3-J_B1
st8 [r10] = r3, J_B4-J_B2
mov r2 = b3
mov r3 = b4
;;
st8 [r11] = r2, J_B5-J_B3
st8 [r10] = r3
mov r2 = b5
;;
st8 [r11] = r2
;;
//
// return
//
mov r8 = r0 // return 0 from setjmp
mov ar.unat = r14 // restore unat
br.ret.sptk b0
PROCEDURE_EXIT(SetJump) stf.spill.nta [in0] = f4, 0x10
st8.spill.nta [r10] = r6, 8
mov r23 = b3
stf.spill.nta [in0] = f5, 0x10
st8.spill.nta [r10] = r7, 8
mov r24 = b4
// stf.spill.nta [in0] = f16, 0x10
// void _LongJump(struct jmp_buffer *) st8.spill.nta [r10] = sp, 8
// mov r25 = b5
// Perform a non-local goto.
//
// Description:
//
// LongJump initializes the register set to the values saved by a
// previous 'SetJump' and jumps to the return location saved by that
// 'SetJump'. This has the effect of unwinding the stack and returning
// for a second time to the 'SetJump'.
//
PROCEDURE_ENTRY(_LongJump) stf.spill.nta [in0] = f17, 0x10
// st8.nta [r10] = loc1, 8
// Make sure buffer is aligned at 16byte boundary mov r16 = pr
//
mov r32 = r33
add r10 = -0x10,r0 ;; // mask the lower 4 bits stf.spill.nta [in0] = f18, 0x10
and r32 = r32, r10;; st8.nta [r10] = r21, 8
add r32 = 0x10, r32;; // move to next 16 byte boundary mov r17 = ar.lc
// stf.spill.nta [in0] = f19, 0x10
// caching the return value as we do invala in the end st8.nta [r10] = r22, 8
//
/// mov r8 = r33 // return value
mov r8 = 1 // For now return hard coded 1
// stf.spill.nta [in0] = f20, 0x10
// get immediate context st8.nta [r10] = r23, 8
//
mov r14 = ar.rsc // get user RSC conf
add r10 = J_PFS, r32 // get address of pfs
add r11 = J_NATS, r32
;;
ld8 r15 = [r10], J_BSP-J_PFS // get pfs
ld8 r2 = [r11], J_LC-J_NATS // get unat for spilled regs
;;
mov ar.unat = r2
;;
ld8 r16 = [r10], J_PREDS-J_BSP // get backing store pointer
mov ar.rsc = r0 // put RSE in enforced lazy
mov ar.pfs = r15
;;
//
// while returning from longjmp the BSPSTORE and BSP needs to be
// same and discard all the registers allocated after we did
// setjmp. Also, we need to generate the RNAT register since we
// did not flushed the RSE on setjmp.
//
mov r17 = ar.bspstore // get current BSPSTORE
;;
cmp.ltu p6,p7 = r17, r16 // is it less than BSP of
(p6) br.spnt.few .flush_rse
mov r19 = ar.rnat // get current RNAT
;;
loadrs // invalidate dirty regs
br.sptk.many .restore_rnat // restore RNAT
.flush_rse: stf.spill.nta [in0] = f21, 0x10
flushrs st8.nta [r10] = r24, 8
;;
mov r19 = ar.rnat // get current RNAT
mov r17 = r16 // current BSPSTORE
;;
.restore_rnat:
//
// check if RNAT is saved between saved BSP and curr BSPSTORE
//
dep r18 = 1,r16,3,6 // get RNAT address
;;
cmp.ltu p8,p9 = r18, r17 // RNAT saved on RSE
;;
(p8) ld8 r19 = [r18] // get RNAT from RSE
;;
mov ar.bspstore = r16 // set new BSPSTORE
;;
mov ar.rnat = r19 // restore RNAT
mov ar.rsc = r14 // restore RSC conf
stf.spill.nta [in0] = f22, 0x10
st8.nta [r10] = r25, 8
ld8 r3 = [r11], J_R4-J_LC // get lc register stf.spill.nta [in0] = f23, 0x10
ld8 r2 = [r10], J_R5-J_PREDS // get predicates mov r18 = ar.unat
;;
mov pr = r2, -1
mov ar.lc = r3
//
// restore preserved general registers & NaT's
//
ld8.fill r4 = [r11], J_R6-J_R4
;;
ld8.fill r5 = [r10], J_R7-J_R5
ld8.fill r6 = [r11], J_SP-J_R6
;;
ld8.fill r7 = [r10], J_F2-J_R7
ld8.fill sp = [r11], J_F3-J_SP
;;
//
// restore floating registers
//
ldf.fill f2 = [r10], J_F4-J_F2
ldf.fill f3 = [r11], J_F5-J_F3
;;
ldf.fill f4 = [r10], J_F16-J_F4
ldf.fill f5 = [r11], J_F17-J_F5
;;
ldf.fill f16 = [r10], J_F18-J_F16
ldf.fill f17 = [r11], J_F19-J_F17
;;
ldf.fill f18 = [r10], J_F20-J_F18
ldf.fill f19 = [r11], J_F21-J_F19
;;
ldf.fill f20 = [r10], J_F22-J_F20
ldf.fill f21 = [r11], J_F23-J_F21
;;
ldf.fill f22 = [r10], J_F24-J_F22
ldf.fill f23 = [r11], J_F25-J_F23
;;
ldf.fill f24 = [r10], J_F26-J_F24
ldf.fill f25 = [r11], J_F27-J_F25
;;
ldf.fill f26 = [r10], J_F28-J_F26
ldf.fill f27 = [r11], J_F29-J_F27
;;
ldf.fill f28 = [r10], J_F30-J_F28
ldf.fill f29 = [r11], J_F31-J_F29
;;
ldf.fill f30 = [r10], J_FPSR-J_F30
ldf.fill f31 = [r11], J_B0-J_F31 ;;
// stf.spill.nta [in0] = f24, 0x10
// restore branch registers and fpsr st8.nta [r10] = r14, 8 // UNAT
//
ld8 r16 = [r10], J_B1-J_FPSR // get fpsr
ld8 r17 = [r11], J_B2-J_B0 // get return pointer
;;
mov ar.fpsr = r16
mov b0 = r17
ld8 r2 = [r10], J_B3-J_B1
ld8 r3 = [r11], J_B4-J_B2
;;
mov b1 = r2
mov b2 = r3
ld8 r2 = [r10], J_B5-J_B3
ld8 r3 = [r11]
;;
mov b3 = r2
mov b4 = r3
ld8 r2 = [r10]
ld8 r21 = [r32] // get user unat
;;
mov b5 = r2
mov ar.unat = r21
// stf.spill.nta [in0] = f25, 0x10
// invalidate ALAT st8.nta [r10] = r18, 8 // UNAT after spill
//
invala ;;
br.ret.sptk b0 stf.spill.nta [in0] = f26, 0x10
PROCEDURE_EXIT(_LongJump) st8.nta [r10] = loc0, 8 // PFS
stf.spill.nta [in0] = f27, 0x10
st8.nta [r10] = r15, 8 // BSP
mov r8 = 0
stf.spill.nta [in0] = f28, 0x10
mov r19 = ar.fpsr
stf.spill.nta [in0] = f29, 0x10
st8.nta [r10] = r16, 8 // PR
mov ar.pfs = loc0
stf.spill.nta [in0] = f30, 0x10
st8.nta [r10] = r17, 8 // LC
mov b0 = loc1
stf.spill.nta [in0] = f31, 0x10
st8.nta [r10] = r19 // FPSR
mov ar.unat = r14
br.ret.sptk b0
.endp SetJump

View File

@ -1,5 +1,5 @@
/** @file /** @file
Long Jump functions. Long Jump functions.
Copyright (c) 2006, Intel Corporation Copyright (c) 2006, Intel Corporation
All rights reserved. This program and the accompanying materials All rights reserved. This program and the accompanying materials
@ -16,9 +16,15 @@
VOID VOID
EFIAPI EFIAPI
_LongJump ( InternalAssertJumpBuffer (
IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer, IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer
IN UINTN Value );
VOID
EFIAPI
InternalLongJump (
IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer,
IN UINTN Value
); );
/** /**
@ -38,12 +44,10 @@ _LongJump (
VOID VOID
EFIAPI EFIAPI
LongJump ( LongJump (
IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer, IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer,
IN UINTN Value IN UINTN Value
) )
{ {
ASSERT (JumpBuffer != NULL); InternalAssertJumpBuffer (JumpBuffer);
ASSERT (Value != 0); InternalLongJump (JumpBuffer, Value);
_LongJump (JumpBuffer, Value);
} }

View File

@ -0,0 +1,28 @@
/** @file
Internal ASSERT () functions for SetJump.
Copyright (c) 2006, Intel Corporation
All rights reserved. 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.
Module Name: SetJumpLongJump.c
**/
VOID
EFIAPI
InternalAssertJumpBuffer (
IN BASE_LIBRARY_JUMP_BUFFER *JumpBuffer
)
{
ASSERT (JumpBuffer != NULL);
#ifdef MDE_CPU_IPF
ASSERT (((UINTN)JumpBuffer & 0xf) == 0);
#endif
}

View File

@ -47,5 +47,9 @@ SwitchStack (
{ {
ASSERT (EntryPoint != NULL && NewStack != NULL); ASSERT (EntryPoint != NULL && NewStack != NULL);
#ifdef MDE_CPU_IPF
ASSERT (((UINTN)NewStack & 0xf) == 0);
#endif
InternalSwitchStack (EntryPoint, Context1, Context2, NewStack); InternalSwitchStack (EntryPoint, Context1, Context2, NewStack);
} }

View File

@ -0,0 +1,64 @@
;------------------------------------------------------------------------------
;
; Copyright (c) 2006, Intel Corporation
; All rights reserved. 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.
;
; Module Name:
;
; CpuId.Asm
;
; Abstract:
;
; AsmCpuid function
;
; Notes:
;
;------------------------------------------------------------------------------
.code
;------------------------------------------------------------------------------
; UINT32
; EFIAPI
; AsmCpuid (
; IN UINT32 RegisterInEax,
; IN UINT32 RegisterInEcx,
; OUT UINT32 *RegisterOutEax OPTIONAL,
; OUT UINT32 *RegisterOutEbx OPTIONAL,
; OUT UINT32 *RegisterOutEcx OPTIONAL,
; OUT UINT32 *RegisterOutEdx OPTIONAL
; )
;------------------------------------------------------------------------------
AsmCpuidEx PROC USES rbx
mov eax, ecx
mov ecx, edx
push rax ; save Index on stack
cpuid
mov r10, [rsp + 38h]
test r10, r10
jz @F
mov [r10], ecx
@@:
mov rcx, r8
jrcxz @F
mov [rcx], eax
@@:
mov rcx, r9
jrcxz @F
mov [rcx], ebx
@@:
mov rcx, [rsp + 40h]
jrcxz @F
mov [rcx], edx
@@:
pop rax ; restore Index to rax as return value
ret
AsmCpuidEx ENDP
END

View File

@ -21,7 +21,7 @@
.code .code
_LongJump PROC IntenralLongJump PROC
mov rbx, [rcx] mov rbx, [rcx]
mov rsp, [rcx + 8] mov rsp, [rcx + 8]
mov rbp, [rcx + 10h] mov rbp, [rcx + 10h]
@ -33,6 +33,6 @@ _LongJump PROC
mov r15, [rcx + 40h] mov r15, [rcx + 40h]
mov rax, rdx mov rax, rdx
jmp qword ptr [rcx + 48h] jmp qword ptr [rcx + 48h]
_LongJump ENDP IntenralLongJump ENDP
END END

View File

@ -21,7 +21,14 @@
.code .code
EXTERNDEF InternalAssertJumpBuffer:PROC
SetJump PROC SetJump PROC
push rcx
add rsp, -20h
call InternalAssertJumpBuffer
add rsp, 20h
pop rcx
pop rdx pop rdx
mov [rcx], rbx mov [rcx], rbx
mov [rcx + 8], rsp mov [rcx + 8], rsp