Added incremental support in GenFds

[mirror_edk2.git] / MdeModulePkg / Universal / EbcDxe / Ia32 / EbcSupport.c

/** @file\r
  This module contains EBC support routines that are customized based on\r
  the target processor.\r
\r
Copyright (c) 2006, Intel Corporation\r
All rights reserved. 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
**/\r
\r
#include "EbcInt.h"\r
#include "EbcExecute.h"\r
\r
//\r
// NOTE: This is the stack size allocated for the interpreter\r
//       when it executes an EBC image. The requirements can change\r
//       based on whether or not a debugger is present, and other\r
//       platform-specific configurations.\r
//\r
#define VM_STACK_SIZE   (1024 * 4)\r
#define EBC_THUNK_SIZE  32\r
\r
#define STACK_REMAIN_SIZE (1024 * 4)\r
\r
\r
/**\r
  This function is called to execute an EBC CALLEX instruction.\r
  The function check the callee's content to see whether it is common native\r
  code or a thunk to another piece of EBC code.\r
  If the callee is common native code, use EbcLLCAllEXASM to manipulate,\r
  otherwise, set the VM->IP to target EBC code directly to avoid another VM\r
  be startup which cost time and stack space.\r
\r
  @parm VmPtr              Pointer to a VM context.\r
  @parm FuncAddr           Callee's address\r
  @parm NewStackPointer    New stack pointer after the call\r
  @parm FramePtr           New frame pointer after the call\r
  @parm Size               The size of call instruction\r
\r
  @return None.\r
\r
**/\r
VOID\r
EbcLLCALLEX (\r
  IN VM_CONTEXT   *VmPtr,\r
  IN UINTN        FuncAddr,\r
  IN UINTN        NewStackPointer,\r
  IN VOID         *FramePtr,\r
  IN UINT8        Size\r
  )\r
{\r
  UINTN    IsThunk;\r
  UINTN    TargetEbcAddr;\r
\r
  IsThunk       = 1;\r
  TargetEbcAddr = 0;\r
\r
  //\r
  // Processor specific code to check whether the callee is a thunk to EBC.\r
  //\r
  if (*((UINT8 *)FuncAddr) != 0xB8) {\r
    IsThunk = 0;\r
    goto Action;\r
  }\r
  if (*((UINT8 *)FuncAddr + 1) != 0xBC)  {\r
    IsThunk = 0;\r
    goto Action;\r
  }\r
  if (*((UINT8 *)FuncAddr + 2) != 0x2E)  {\r
    IsThunk = 0;\r
    goto Action;\r
  }\r
  if (*((UINT8 *)FuncAddr + 3) != 0x11)  {\r
    IsThunk = 0;\r
    goto Action;\r
  }\r
  if (*((UINT8 *)FuncAddr + 4) != 0xCA)  {\r
    IsThunk = 0;\r
    goto Action;\r
  }\r
  if (*((UINT8 *)FuncAddr + 5) != 0xB8)  {\r
    IsThunk = 0;\r
    goto Action;\r
  }\r
  if (*((UINT8 *)FuncAddr + 10) != 0xB9)  {\r
    IsThunk = 0;\r
    goto Action;\r
  }\r
  if (*((UINT8 *)FuncAddr + 15) != 0xFF)  {\r
    IsThunk = 0;\r
    goto Action;\r
  }\r
  if (*((UINT8 *)FuncAddr + 16) != 0xE1)  {\r
    IsThunk = 0;\r
    goto Action;\r
  }\r
\r
  TargetEbcAddr = ((UINTN)(*((UINT8 *)FuncAddr + 9)) << 24) + ((UINTN)(*((UINT8 *)FuncAddr + 8)) << 16) +\r
                    ((UINTN)(*((UINT8 *)FuncAddr + 7)) << 8) + ((UINTN)(*((UINT8 *)FuncAddr + 6)));\r
\r
Action:\r
  if (IsThunk == 1){\r
    //\r
    // The callee is a thunk to EBC, adjust the stack pointer down 16 bytes and\r
    // put our return address and frame pointer on the VM stack.\r
    // Then set the VM's IP to new EBC code.\r
    //\r
    VmPtr->R[0] -= 8;\r
    VmWriteMemN (VmPtr, (UINTN) VmPtr->R[0], (UINTN) FramePtr);\r
    VmPtr->FramePtr = (VOID *) (UINTN) VmPtr->R[0];\r
    VmPtr->R[0] -= 8;\r
    VmWriteMem64 (VmPtr, (UINTN) VmPtr->R[0], (UINT64) (UINTN) (VmPtr->Ip + Size));\r
\r
    VmPtr->Ip = (VMIP) (UINTN) TargetEbcAddr;\r
  } else {\r
    //\r
    // The callee is not a thunk to EBC, call native code.\r
    //\r
    EbcLLCALLEXNative (FuncAddr, NewStackPointer, FramePtr);\r
\r
    //\r
    // Get return value and advance the IP.\r
    //\r
    VmPtr->R[7] = EbcLLGetReturnValue ();\r
    VmPtr->Ip += Size;\r
  }\r
}\r
\r
\r
/**\r
  Begin executing an EBC image. The address of the entry point is passed\r
  in via a processor register, so we'll need to make a call to get the\r
  value.\r
\r
  None. Since we're called from a fixed up thunk (which we want to keep\r
  small), our only so-called argument is the EBC entry point passed in\r
  to us in a processor register.\r
\r
  @return The value returned by the EBC application we're going to run.\r
\r
**/\r
STATIC\r
UINT64\r
EbcInterpret (\r
  IN OUT UINTN      Arg1,\r
  IN OUT UINTN      Arg2,\r
  IN OUT UINTN      Arg3,\r
  IN OUT UINTN      Arg4,\r
  IN OUT UINTN      Arg5,\r
  IN OUT UINTN      Arg6,\r
  IN OUT UINTN      Arg7,\r
  IN OUT UINTN      Arg8,\r
  IN OUT UINTN      Arg9,\r
  IN OUT UINTN      Arg10,\r
  IN OUT UINTN      Arg11,\r
  IN OUT UINTN      Arg12,\r
  IN OUT UINTN      Arg13,\r
  IN OUT UINTN      Arg14,\r
  IN OUT UINTN      Arg15,\r
  IN OUT UINTN      Arg16\r
  )\r
{\r
  //\r
  // Create a new VM context on the stack\r
  //\r
  VM_CONTEXT  VmContext;\r
  UINTN       Addr;\r
  EFI_STATUS  Status;\r
  UINTN       StackIndex;\r
\r
  //\r
  // Get the EBC entry point from the processor register.\r
  //\r
  Addr = EbcLLGetEbcEntryPoint ();\r
\r
  //\r
  // Now clear out our context\r
  //\r
  ZeroMem ((VOID *) &VmContext, sizeof (VM_CONTEXT));\r
\r
  //\r
  // Set the VM instruction pointer to the correct location in memory.\r
  //\r
  VmContext.Ip = (VMIP) Addr;\r
  //\r
  // Initialize the stack pointer for the EBC. Get the current system stack\r
  // pointer and adjust it down by the max needed for the interpreter.\r
  //\r
\r
  //\r
  // Align the stack on a natural boundary\r
  //\r
\r
  //\r
  // Allocate stack pool\r
  //\r
  Status = GetEBCStack((EFI_HANDLE)-1, &VmContext.StackPool, &StackIndex);\r
  if (EFI_ERROR(Status)) {\r
    return Status;\r
  }\r
  VmContext.StackTop = (UINT8*)VmContext.StackPool + (STACK_REMAIN_SIZE);\r
  VmContext.R[0] = (UINT64)(UINTN) ((UINT8*)VmContext.StackPool + STACK_POOL_SIZE);\r
  VmContext.HighStackBottom = (UINTN)VmContext.R[0];\r
  VmContext.R[0] &= ~(sizeof (UINTN) - 1);\r
  VmContext.R[0] -= sizeof (UINTN);\r
\r
  //\r
  // Put a magic value in the stack gap, then adjust down again\r
  //\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) VM_STACK_KEY_VALUE;\r
  VmContext.StackMagicPtr             = (UINTN *) (UINTN) VmContext.R[0];\r
  VmContext.LowStackTop   = (UINTN) VmContext.R[0];\r
\r
  //\r
  // For IA32, this is where we say our return address is\r
  //\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg16;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg15;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg14;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg13;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg12;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg11;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg10;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg9;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg8;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg7;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg6;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg5;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg4;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg3;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg2;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) Arg1;\r
  VmContext.R[0] -= 16;\r
  VmContext.StackRetAddr  = (UINT64) VmContext.R[0];\r
\r
  //\r
  // We need to keep track of where the EBC stack starts. This way, if the EBC\r
  // accesses any stack variables above its initial stack setting, then we know\r
  // it's accessing variables passed into it, which means the data is on the\r
  // VM's stack.\r
  // When we're called, on the stack (high to low) we have the parameters, the\r
  // return address, then the saved ebp. Save the pointer to the return address.\r
  // EBC code knows that's there, so should look above it for function parameters.\r
  // The offset is the size of locals (VMContext + Addr + saved ebp).\r
  // Note that the interpreter assumes there is a 16 bytes of return address on\r
  // the stack too, so adjust accordingly.\r
  //  VmContext.HighStackBottom = (UINTN)(Addr + sizeof (VmContext) + sizeof (Addr));\r
  //\r
\r
  //\r
  // Begin executing the EBC code\r
  //\r
  EbcExecute (&VmContext);\r
\r
  //\r
  // Return the value in R[7] unless there was an error\r
  //\r
  ReturnEBCStack(StackIndex);\r
  return (UINT64) VmContext.R[7];\r
}\r
\r
\r
/**\r
  Begin executing an EBC image. The address of the entry point is passed\r
  in via a processor register, so we'll need to make a call to get the\r
  value.\r
\r
  @param  ImageHandle    image handle for the EBC application we're executing\r
  @param  SystemTable    standard system table passed into an driver's entry point\r
\r
  @return The value returned by the EBC application we're going to run.\r
\r
**/\r
STATIC\r
UINT64\r
ExecuteEbcImageEntryPoint (\r
  IN EFI_HANDLE           ImageHandle,\r
  IN EFI_SYSTEM_TABLE     *SystemTable\r
  )\r
{\r
  //\r
  // Create a new VM context on the stack\r
  //\r
  VM_CONTEXT  VmContext;\r
  UINTN       Addr;\r
  EFI_STATUS  Status;\r
  UINTN       StackIndex;\r
\r
  //\r
  // Get the EBC entry point from the processor register. Make sure you don't\r
  // call any functions before this or you could mess up the register the\r
  // entry point is passed in.\r
  //\r
  Addr = EbcLLGetEbcEntryPoint ();\r
\r
  //\r
  //  Print(L"*** Thunked into EBC entry point - ImageHandle = 0x%X\n", (UINTN)ImageHandle);\r
  //  Print(L"EBC entry point is 0x%X\n", (UINT32)(UINTN)Addr);\r
  //\r
  // Now clear out our context\r
  //\r
  ZeroMem ((VOID *) &VmContext, sizeof (VM_CONTEXT));\r
\r
  //\r
  // Save the image handle so we can track the thunks created for this image\r
  //\r
  VmContext.ImageHandle = ImageHandle;\r
  VmContext.SystemTable = SystemTable;\r
\r
  //\r
  // Set the VM instruction pointer to the correct location in memory.\r
  //\r
  VmContext.Ip = (VMIP) Addr;\r
\r
  //\r
  // Initialize the stack pointer for the EBC. Get the current system stack\r
  // pointer and adjust it down by the max needed for the interpreter.\r
  //\r
\r
  //\r
  // Allocate stack pool\r
  //\r
  Status = GetEBCStack(ImageHandle, &VmContext.StackPool, &StackIndex);\r
  if (EFI_ERROR(Status)) {\r
    return Status;\r
  }\r
  VmContext.StackTop = (UINT8*)VmContext.StackPool + (STACK_REMAIN_SIZE);\r
  VmContext.R[0] = (UINT64)(UINTN) ((UINT8*)VmContext.StackPool + STACK_POOL_SIZE);\r
  VmContext.HighStackBottom = (UINTN)VmContext.R[0];\r
  VmContext.R[0] -= sizeof (UINTN);\r
\r
  //\r
  // Put a magic value in the stack gap, then adjust down again\r
  //\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) VM_STACK_KEY_VALUE;\r
  VmContext.StackMagicPtr             = (UINTN *) (UINTN) VmContext.R[0];\r
\r
  //\r
  // Align the stack on a natural boundary\r
  //  VmContext.R[0] &= ~(sizeof(UINTN) - 1);\r
  //\r
  VmContext.LowStackTop   = (UINTN) VmContext.R[0];\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) SystemTable;\r
  VmContext.R[0] -= sizeof (UINTN);\r
  *(UINTN *) (UINTN) (VmContext.R[0]) = (UINTN) ImageHandle;\r
\r
  VmContext.R[0] -= 16;\r
  VmContext.StackRetAddr  = (UINT64) VmContext.R[0];\r
  //\r
  // VM pushes 16-bytes for return address. Simulate that here.\r
  //\r
\r
  //\r
  // Begin executing the EBC code\r
  //\r
  EbcExecute (&VmContext);\r
\r
  //\r
  // Return the value in R[7] unless there was an error\r
  //\r
  return (UINT64) VmContext.R[7];\r
}\r
\r
\r
/**\r
  Create an IA32 thunk for the given EBC entry point.\r
\r
  @param  ImageHandle    Handle of image for which this thunk is being created\r
  @param  EbcEntryPoint  Address of the EBC code that the thunk is to call\r
  @param  Thunk          Returned thunk we create here\r
\r
  @return Standard EFI status.\r
\r
**/\r
EFI_STATUS\r
EbcCreateThunks (\r
  IN EFI_HANDLE           ImageHandle,\r
  IN VOID                 *EbcEntryPoint,\r
  OUT VOID                **Thunk,\r
  IN  UINT32              Flags\r
  )\r
{\r
  UINT8       *Ptr;\r
  UINT8       *ThunkBase;\r
  UINT32      I;\r
  UINT32      Addr;\r
  INT32       Size;\r
  INT32       ThunkSize;\r
\r
  //\r
  // Check alignment of pointer to EBC code\r
  //\r
  if ((UINT32) (UINTN) EbcEntryPoint & 0x01) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  Size      = EBC_THUNK_SIZE;\r
  ThunkSize = Size;\r
\r
  Ptr = AllocatePool (Size);\r
\r
  if (Ptr == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
  //\r
  //  Print(L"Allocate TH: 0x%X\n", (UINT32)Ptr);\r
  //\r
  // Save the start address so we can add a pointer to it to a list later.\r
  //\r
  ThunkBase = Ptr;\r
\r
  //\r
  // Give them the address of our buffer we're going to fix up\r
  //\r
  *Thunk = (VOID *) Ptr;\r
\r
  //\r
  // Add a magic code here to help the VM recognize the thunk..\r
  // mov eax, 0xca112ebc  => B8 BC 2E 11 CA\r
  //\r
  *Ptr = 0xB8;\r
  Ptr++;\r
  Size--;\r
  Addr = (UINT32) 0xCA112EBC;\r
  for (I = 0; I < sizeof (Addr); I++) {\r
    *Ptr = (UINT8) (UINTN) Addr;\r
    Addr >>= 8;\r
    Ptr++;\r
    Size--;\r
  }\r
\r
  //\r
  // Add code bytes to load up a processor register with the EBC entry point.\r
  // mov eax, 0xaa55aa55  => B8 55 AA 55 AA\r
  // The first 8 bytes of the thunk entry is the address of the EBC\r
  // entry point.\r
  //\r
  *Ptr = 0xB8;\r
  Ptr++;\r
  Size--;\r
  Addr = (UINT32) EbcEntryPoint;\r
  for (I = 0; I < sizeof (Addr); I++) {\r
    *Ptr = (UINT8) (UINTN) Addr;\r
    Addr >>= 8;\r
    Ptr++;\r
    Size--;\r
  }\r
  //\r
  // Stick in a load of ecx with the address of appropriate VM function.\r
  //  mov ecx 12345678h  => 0xB9 0x78 0x56 0x34 0x12\r
  //\r
  if (Flags & FLAG_THUNK_ENTRY_POINT) {\r
    Addr = (UINT32) (UINTN) ExecuteEbcImageEntryPoint;\r
  } else {\r
    Addr = (UINT32) (UINTN) EbcInterpret;\r
  }\r
\r
  //\r
  // MOV ecx\r
  //\r
  *Ptr = 0xB9;\r
  Ptr++;\r
  Size--;\r
  for (I = 0; I < sizeof (Addr); I++) {\r
    *Ptr = (UINT8) Addr;\r
    Addr >>= 8;\r
    Ptr++;\r
    Size--;\r
  }\r
  //\r
  // Stick in jump opcode bytes for jmp ecx => 0xFF 0xE1\r
  //\r
  *Ptr = 0xFF;\r
  Ptr++;\r
  Size--;\r
  *Ptr = 0xE1;\r
  Size--;\r
\r
  //\r
  // Double check that our defined size is ok (application error)\r
  //\r
  if (Size < 0) {\r
    ASSERT (FALSE);\r
    return EFI_BUFFER_TOO_SMALL;\r
  }\r
  //\r
  // Add the thunk to the list for this image. Do this last since the add\r
  // function flushes the cache for us.\r
  //\r
  EbcAddImageThunk (ImageHandle, (VOID *) ThunkBase, ThunkSize);\r
\r
  return EFI_SUCCESS;\r
}\r