1113 lines
27 KiB
C
1113 lines
27 KiB
C
|
/*++
|
|||
|
|
|||
|
Copyright (c) 1991 Microsoft Corporation
|
|||
|
|
|||
|
Module Name:
|
|||
|
|
|||
|
alignem.c
|
|||
|
|
|||
|
Abstract:
|
|||
|
|
|||
|
This module implement the code necessary to emulate unaliged data
|
|||
|
references.
|
|||
|
|
|||
|
Author:
|
|||
|
|
|||
|
David N. Cutler (davec) 17-Jun-1991
|
|||
|
|
|||
|
Environment:
|
|||
|
|
|||
|
Kernel mode only.
|
|||
|
|
|||
|
Revision History:
|
|||
|
|
|||
|
--*/
|
|||
|
|
|||
|
#include "ki.h"
|
|||
|
|
|||
|
#define OPCODE_MASK 0x1EF00000000
|
|||
|
|
|||
|
#define LD_OP 0x08000000000
|
|||
|
#define LDS_OP 0x08100000000
|
|||
|
#define LDA_OP 0x08200000000
|
|||
|
#define LDSA_OP 0x08300000000
|
|||
|
#define LDBIAS_OP 0x08400000000
|
|||
|
#define LDACQ_OP 0x08500000000
|
|||
|
#define LDCCLR_OP 0x08800000000
|
|||
|
#define LDCNC_OP 0x08900000000
|
|||
|
#define LDCCLRACQ_OP 0x08A00000000
|
|||
|
#define ST_OP 0x08C00000000
|
|||
|
#define STREL_OP 0x08D00000000
|
|||
|
|
|||
|
#define LD_IMM_OP 0x0A000000000
|
|||
|
#define LDS_IMM_OP 0x0A100000000
|
|||
|
#define LDA_IMM_OP 0x0A200000000
|
|||
|
#define LDSA_IMM_OP 0x0A300000000
|
|||
|
#define LDBIAS_IMM_OP 0x0A400000000
|
|||
|
#define LDACQ_IMM_OP 0x0A500000000
|
|||
|
#define LDCCLR_IMM_OP 0x0A800000000
|
|||
|
#define LDCNC_IMM_OP 0x0A900000000
|
|||
|
#define LDCCLRACQ_IMM_OP 0x0AA00000000
|
|||
|
#define ST_IMM_OP 0x0AC00000000
|
|||
|
#define STREL_IMM_OP 0x0AD00000000
|
|||
|
|
|||
|
#define LDF_OP 0x0C000000000
|
|||
|
#define LDFS_OP 0x0C100000000
|
|||
|
#define LDFA_OP 0x0C200000000
|
|||
|
#define LDFSA_OP 0x0C300000000
|
|||
|
#define LDFCCLR_OP 0x0C800000000
|
|||
|
#define LDFCNC_OP 0x0C900000000
|
|||
|
#define STF_OP 0x0CC00000000
|
|||
|
|
|||
|
#define LDF_IMM_OP 0x0E000000000
|
|||
|
#define LDFS_IMM_OP 0x0E100000000
|
|||
|
#define LDFA_IMM_OP 0x0E200000000
|
|||
|
#define LDFSA_IMM_OP 0x0E300000000
|
|||
|
#define LDFCCLR_IMM_OP 0x0E800000000
|
|||
|
#define LDFCNC_IMM_OP 0x0E900000000
|
|||
|
#define STF_IMM_OP 0x0EC00000000
|
|||
|
|
|||
|
typedef struct _INST_FORMAT {
|
|||
|
union {
|
|||
|
struct {
|
|||
|
ULONGLONG qp: 6;
|
|||
|
ULONGLONG r1: 7;
|
|||
|
ULONGLONG r2: 7;
|
|||
|
ULONGLONG r3: 7;
|
|||
|
ULONGLONG x: 1;
|
|||
|
ULONGLONG hint: 2;
|
|||
|
ULONGLONG x6: 6;
|
|||
|
ULONGLONG m: 1;
|
|||
|
ULONGLONG Op: 4;
|
|||
|
ULONGLONG Rsv: 23;
|
|||
|
} i_field;
|
|||
|
ULONGLONG Ulong64;
|
|||
|
} u;
|
|||
|
} INST_FORMAT;
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateLoad(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
IN ULONG OperandSize,
|
|||
|
IN PVOID Data
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateStore(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
IN ULONG OperandSize,
|
|||
|
IN PVOID Data
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateLoadFloat(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
IN ULONG OperandSize,
|
|||
|
IN PVOID Data
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateStoreFloat(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
IN ULONG OperandSize,
|
|||
|
IN PVOID Data
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateLoadFloat80(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
OUT PVOID FloatData
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateLoadFloatInt(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
OUT PVOID FloatData
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateLoadFloat32(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
OUT PVOID FloatData
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateLoadFloat64(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
OUT PVOID FloatData
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateStoreFloat80(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
OUT PVOID FloatData
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateStoreFloatInt(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
OUT PVOID FloatData
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateStoreFloat32(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
OUT PVOID FloatData
|
|||
|
);
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateStoreFloat64(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
OUT PVOID FloatData
|
|||
|
);
|
|||
|
|
|||
|
|
|||
|
BOOLEAN
|
|||
|
KiEmulateReference (
|
|||
|
IN OUT PEXCEPTION_RECORD ExceptionRecord,
|
|||
|
IN OUT PKEXCEPTION_FRAME ExceptionFrame,
|
|||
|
IN OUT PKTRAP_FRAME TrapFrame
|
|||
|
)
|
|||
|
|
|||
|
/*++
|
|||
|
|
|||
|
Routine Description:
|
|||
|
|
|||
|
This function is called to emulate an unaligned data reference to an
|
|||
|
address in the user part of the address space.
|
|||
|
|
|||
|
Arguments:
|
|||
|
|
|||
|
ExceptionRecord - Supplies a pointer to an exception record.
|
|||
|
|
|||
|
ExceptionFrame - Supplies a pointer to an exception frame.
|
|||
|
|
|||
|
TrapFrame - Supplies a pointer to a trap frame.
|
|||
|
|
|||
|
Return Value:
|
|||
|
|
|||
|
A value of TRUE is returned if the data reference is successfully
|
|||
|
emulated. Otherwise, a value of FALSE is returned.
|
|||
|
|
|||
|
--*/
|
|||
|
|
|||
|
{
|
|||
|
|
|||
|
PVOID EffectiveAddress;
|
|||
|
PVOID ExceptionAddress;
|
|||
|
KIRQL OldIrql;
|
|||
|
KPROCESSOR_MODE PreviousMode;
|
|||
|
INST_FORMAT FaultInstruction;
|
|||
|
ULONGLONG Opcode;
|
|||
|
ULONGLONG Reg2Value;
|
|||
|
ULONGLONG Reg3Value;
|
|||
|
ULONGLONG BundleLow;
|
|||
|
ULONGLONG BundleHigh;
|
|||
|
ULONGLONG Syllable;
|
|||
|
ULONGLONG Data = 0;
|
|||
|
ULONGLONG ImmValue;
|
|||
|
ULONG OpSize;
|
|||
|
ULONG Length;
|
|||
|
ULONG Sor;
|
|||
|
ULONG Rrbgr;
|
|||
|
ULONG Rrbfr;
|
|||
|
ULONG Operand1, Operand2, Operand3;
|
|||
|
FLOAT128 FloatData = {0, 0};
|
|||
|
|
|||
|
//
|
|||
|
// Must flush the RSE to synchronize the RSE and backing store contents
|
|||
|
//
|
|||
|
|
|||
|
KiFlushRse();
|
|||
|
|
|||
|
if (TrapFrame->PreviousMode == UserMode) {
|
|||
|
KeFlushUserRseState(TrapFrame);
|
|||
|
}
|
|||
|
|
|||
|
//
|
|||
|
// Call out to profile interrupt if alignment profiling is active
|
|||
|
//
|
|||
|
|
|||
|
if (KiProfileAlignmentFixup) {
|
|||
|
|
|||
|
if (++KiProfileAlignmentFixupCount >= KiProfileAlignmentFixupInterval) {
|
|||
|
|
|||
|
KeRaiseIrql(PROFILE_LEVEL, &OldIrql);
|
|||
|
KiProfileAlignmentFixupCount = 0;
|
|||
|
KeProfileInterruptWithSource(TrapFrame, ProfileAlignmentFixup);
|
|||
|
KeLowerIrql(OldIrql);
|
|||
|
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
//
|
|||
|
// Save the original exception address in case another exception
|
|||
|
// occurs.
|
|||
|
//
|
|||
|
|
|||
|
EffectiveAddress = (PVOID) ExceptionRecord->ExceptionInformation[1];
|
|||
|
ExceptionAddress = (PVOID) TrapFrame->StIIP;
|
|||
|
|
|||
|
//
|
|||
|
// Capture previous mode from trap frame not current thread.
|
|||
|
//
|
|||
|
|
|||
|
PreviousMode = (KPROCESSOR_MODE) TrapFrame->PreviousMode;
|
|||
|
|
|||
|
//
|
|||
|
// Any exception that occurs during the attempted emulation of the
|
|||
|
// unaligned reference causes the emulation to be aborted. The new
|
|||
|
// exception code and information is copied to the original exception
|
|||
|
// record and a value of FALSE is returned.
|
|||
|
//
|
|||
|
|
|||
|
try {
|
|||
|
|
|||
|
|
|||
|
BundleLow = *((ULONGLONG *)ExceptionAddress);
|
|||
|
BundleHigh = *(((ULONGLONG *)ExceptionAddress) + 1);
|
|||
|
|
|||
|
Syllable = (TrapFrame->StIPSR >> PSR_RI) & 0x3;
|
|||
|
|
|||
|
switch (Syllable) {
|
|||
|
case 0:
|
|||
|
FaultInstruction.u.Ulong64 = (BundleLow >> 5);
|
|||
|
break;
|
|||
|
case 1:
|
|||
|
FaultInstruction.u.Ulong64 = (BundleLow >> 46) | (BundleHigh << 18);
|
|||
|
break;
|
|||
|
case 2:
|
|||
|
FaultInstruction.u.Ulong64 = (BundleHigh >> 23);
|
|||
|
case 3:
|
|||
|
default:
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
Rrbgr = (ULONG)(TrapFrame->StIFS >> 18) & 0x7f;
|
|||
|
Rrbfr = (ULONG)(TrapFrame->StIFS >> 25) & 0x7f;
|
|||
|
Sor = (ULONG)((TrapFrame->StIFS >> 14) & 0xf) * 8;
|
|||
|
Operand1 = (ULONG)FaultInstruction.u.i_field.r1;
|
|||
|
Operand2 = (ULONG)FaultInstruction.u.i_field.r2;
|
|||
|
Operand3 = (ULONG)FaultInstruction.u.i_field.r3;
|
|||
|
|
|||
|
if (Sor > 0) {
|
|||
|
if ((Operand1 >= 32) && ((Operand1-32) < Sor))
|
|||
|
Operand1 = 32 + (Rrbgr + Operand1 - 32) % Sor;
|
|||
|
if ((Operand2 >= 32) && ((Operand2-32) < Sor))
|
|||
|
Operand2 = 32 + (Rrbgr + Operand2 - 32) % Sor;
|
|||
|
if ((Operand3 >= 32) && ((Operand3-32) < Sor))
|
|||
|
Operand3 = 32 + (Rrbgr + Operand3 - 32) % Sor;
|
|||
|
}
|
|||
|
|
|||
|
Opcode = FaultInstruction.u.Ulong64 & OPCODE_MASK;
|
|||
|
OpSize = (ULONG)FaultInstruction.u.i_field.x6 & 0x3;
|
|||
|
|
|||
|
switch (Opcode) {
|
|||
|
|
|||
|
//
|
|||
|
// speculative and speculative advanced load
|
|||
|
//
|
|||
|
|
|||
|
case LDS_OP:
|
|||
|
case LDSA_OP:
|
|||
|
case LDS_IMM_OP:
|
|||
|
case LDSA_IMM_OP:
|
|||
|
case LDFS_OP:
|
|||
|
case LDFSA_OP:
|
|||
|
case LDFS_IMM_OP:
|
|||
|
|
|||
|
//
|
|||
|
// return NaT value to the target register
|
|||
|
//
|
|||
|
|
|||
|
TrapFrame->StIPSR |= (1i64 << PSR_ED);
|
|||
|
|
|||
|
return TRUE;
|
|||
|
|
|||
|
//
|
|||
|
// normal, advance, and check load
|
|||
|
//
|
|||
|
|
|||
|
case LD_OP:
|
|||
|
case LDA_OP:
|
|||
|
case LDBIAS_OP:
|
|||
|
case LDCCLR_OP:
|
|||
|
case LDCNC_OP:
|
|||
|
case LDACQ_OP:
|
|||
|
case LDCCLRACQ_OP:
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.x == 1) {
|
|||
|
|
|||
|
//
|
|||
|
// xField must be 0
|
|||
|
//
|
|||
|
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
if( PreviousMode != KernelMode ){
|
|||
|
ProbeForRead( EffectiveAddress,
|
|||
|
1 << OpSize,
|
|||
|
sizeof(UCHAR) );
|
|||
|
}
|
|||
|
|
|||
|
KiEmulateLoad(EffectiveAddress, OpSize, &Data);
|
|||
|
KiSetRegisterValue( Operand1, Data, ExceptionFrame, TrapFrame );
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.m == 1) {
|
|||
|
|
|||
|
//
|
|||
|
// Update the address register (R3)
|
|||
|
//
|
|||
|
|
|||
|
Reg2Value = KiGetRegisterValue( Operand2, ExceptionFrame,
|
|||
|
TrapFrame );
|
|||
|
|
|||
|
Reg3Value = KiGetRegisterValue( Operand3, ExceptionFrame,
|
|||
|
TrapFrame );
|
|||
|
|
|||
|
//
|
|||
|
// register update form
|
|||
|
//
|
|||
|
|
|||
|
Reg3Value = Reg2Value + Reg3Value;
|
|||
|
|
|||
|
KiSetRegisterValue ( Operand3, Reg3Value,
|
|||
|
ExceptionFrame, TrapFrame);
|
|||
|
}
|
|||
|
|
|||
|
if ((Opcode == LDACQ_OP) || (Opcode == LDCCLRACQ_OP)) {
|
|||
|
|
|||
|
//
|
|||
|
// all future access should occur after unaligned memory access
|
|||
|
//
|
|||
|
|
|||
|
__mf();
|
|||
|
}
|
|||
|
|
|||
|
break;
|
|||
|
|
|||
|
//
|
|||
|
// normal, advance, and check load
|
|||
|
// immidiate updated form
|
|||
|
//
|
|||
|
|
|||
|
case LD_IMM_OP:
|
|||
|
case LDA_IMM_OP:
|
|||
|
case LDBIAS_IMM_OP:
|
|||
|
case LDCCLR_IMM_OP:
|
|||
|
case LDCNC_IMM_OP:
|
|||
|
case LDACQ_IMM_OP:
|
|||
|
case LDCCLRACQ_IMM_OP:
|
|||
|
|
|||
|
if( PreviousMode != KernelMode ){
|
|||
|
ProbeForRead( EffectiveAddress,
|
|||
|
1 << OpSize,
|
|||
|
sizeof(UCHAR) );
|
|||
|
}
|
|||
|
|
|||
|
KiEmulateLoad(EffectiveAddress, OpSize, &Data);
|
|||
|
KiSetRegisterValue( Operand1, Data, ExceptionFrame, TrapFrame );
|
|||
|
|
|||
|
//
|
|||
|
// Update the address register R3
|
|||
|
//
|
|||
|
|
|||
|
Reg3Value = KiGetRegisterValue(Operand3, ExceptionFrame, TrapFrame);
|
|||
|
|
|||
|
//
|
|||
|
// immediate update form
|
|||
|
//
|
|||
|
|
|||
|
ImmValue = (FaultInstruction.u.i_field.r2
|
|||
|
+ (FaultInstruction.u.i_field.x << 7));
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.m == 1) {
|
|||
|
|
|||
|
ImmValue = 0xFFFFFFFFFFFFFF00i64 | ImmValue;
|
|||
|
|
|||
|
}
|
|||
|
|
|||
|
Reg3Value = Reg3Value + ImmValue;
|
|||
|
|
|||
|
KiSetRegisterValue(Operand3, Reg3Value, ExceptionFrame, TrapFrame);
|
|||
|
|
|||
|
if ((Opcode == LDACQ_IMM_OP) || (Opcode == LDCCLRACQ_IMM_OP)) {
|
|||
|
|
|||
|
//
|
|||
|
// all future access should occur after unaligned memory access
|
|||
|
//
|
|||
|
|
|||
|
__mf();
|
|||
|
}
|
|||
|
|
|||
|
break;
|
|||
|
|
|||
|
case LDF_OP:
|
|||
|
case LDFA_OP:
|
|||
|
case LDFCCLR_OP:
|
|||
|
case LDFCNC_OP:
|
|||
|
|
|||
|
if (Operand1 >= 32) Operand1 = 32 + (Rrbfr + Operand1 - 32) % 96;
|
|||
|
if (Operand2 >= 32) Operand2 = 32 + (Rrbfr + Operand2 - 32) % 96;
|
|||
|
if (Operand3 >= 32) Operand3 = 32 + (Rrbfr + Operand3 - 32) % 96;
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.x == 1) {
|
|||
|
|
|||
|
//
|
|||
|
// floating point load pair
|
|||
|
//
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.m == 1) {
|
|||
|
|
|||
|
//
|
|||
|
// m field must be zero
|
|||
|
//
|
|||
|
|
|||
|
return FALSE;
|
|||
|
|
|||
|
}
|
|||
|
|
|||
|
if( PreviousMode != KernelMode ){
|
|||
|
|
|||
|
switch (OpSize) {
|
|||
|
case 0: return FALSE;
|
|||
|
case 1: Length = 8; break;
|
|||
|
case 2: Length = 4; break;
|
|||
|
case 3: Length = 8; break;
|
|||
|
default:
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
ProbeForRead( EffectiveAddress,
|
|||
|
Length << 1,
|
|||
|
sizeof(UCHAR) );
|
|||
|
}
|
|||
|
|
|||
|
//
|
|||
|
// emulate the 1st half of the pair
|
|||
|
//
|
|||
|
|
|||
|
KiEmulateLoadFloat(EffectiveAddress, OpSize, &FloatData);
|
|||
|
KiSetFloatRegisterValue( Operand1, FloatData,
|
|||
|
ExceptionFrame, TrapFrame );
|
|||
|
|
|||
|
//
|
|||
|
// emulate the 2nd half of the pair
|
|||
|
//
|
|||
|
|
|||
|
EffectiveAddress = (PVOID)((ULONG_PTR)EffectiveAddress + Length);
|
|||
|
|
|||
|
KiEmulateLoadFloat(EffectiveAddress, OpSize, &FloatData);
|
|||
|
KiSetFloatRegisterValue( Operand2, FloatData,
|
|||
|
ExceptionFrame, TrapFrame );
|
|||
|
|
|||
|
} else {
|
|||
|
|
|||
|
//
|
|||
|
// floating point single load
|
|||
|
//
|
|||
|
|
|||
|
if( PreviousMode != KernelMode ){
|
|||
|
|
|||
|
switch (OpSize) {
|
|||
|
case 0: Length = 16; break;
|
|||
|
case 1: Length = 8; break;
|
|||
|
case 2: Length = 4; break;
|
|||
|
case 3: Length = 8; break;
|
|||
|
default:
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
ProbeForRead( EffectiveAddress,
|
|||
|
Length,
|
|||
|
sizeof(UCHAR) );
|
|||
|
}
|
|||
|
|
|||
|
KiEmulateLoadFloat(EffectiveAddress, OpSize, &FloatData);
|
|||
|
KiSetFloatRegisterValue( Operand1, FloatData,
|
|||
|
ExceptionFrame, TrapFrame );
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.m == 1) {
|
|||
|
|
|||
|
//
|
|||
|
// update the address register (R3)
|
|||
|
//
|
|||
|
|
|||
|
Reg2Value = KiGetRegisterValue( Operand2,
|
|||
|
ExceptionFrame,
|
|||
|
TrapFrame );
|
|||
|
|
|||
|
Reg3Value = KiGetRegisterValue( Operand3,
|
|||
|
ExceptionFrame,
|
|||
|
TrapFrame );
|
|||
|
//
|
|||
|
// register update form
|
|||
|
//
|
|||
|
|
|||
|
Reg3Value = Reg2Value + Reg3Value;
|
|||
|
|
|||
|
KiSetRegisterValue (Operand3, Reg3Value,
|
|||
|
ExceptionFrame, TrapFrame);
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
break;
|
|||
|
|
|||
|
//
|
|||
|
// normal, advanced and checked floating point load
|
|||
|
// immediate updated form
|
|||
|
//
|
|||
|
|
|||
|
case LDF_IMM_OP:
|
|||
|
case LDFA_IMM_OP:
|
|||
|
case LDFCCLR_IMM_OP:
|
|||
|
case LDFCNC_IMM_OP:
|
|||
|
|
|||
|
if (Operand1 >= 32) Operand1 = 32 + (Rrbfr + Operand1 - 32) % 96;
|
|||
|
if (Operand2 >= 32) Operand2 = 32 + (Rrbfr + Operand2 - 32) % 96;
|
|||
|
if (Operand3 >= 32) Operand3 = 32 + (Rrbfr + Operand3 - 32) % 96;
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.x == 1) {
|
|||
|
|
|||
|
//
|
|||
|
// floating point load pair
|
|||
|
//
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.m == 0) {
|
|||
|
|
|||
|
//
|
|||
|
// m field must be one
|
|||
|
//
|
|||
|
|
|||
|
return FALSE;
|
|||
|
|
|||
|
}
|
|||
|
|
|||
|
if( PreviousMode != KernelMode ){
|
|||
|
|
|||
|
switch (OpSize) {
|
|||
|
case 0: return FALSE;
|
|||
|
case 1: Length = 8; break;
|
|||
|
case 2: Length = 8; break;
|
|||
|
case 3: Length = 4; break;
|
|||
|
default:
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
ProbeForRead( EffectiveAddress,
|
|||
|
Length << 1,
|
|||
|
sizeof(UCHAR) );
|
|||
|
}
|
|||
|
|
|||
|
//
|
|||
|
// emulate the 1st half of the pair
|
|||
|
//
|
|||
|
|
|||
|
KiEmulateLoadFloat(EffectiveAddress, OpSize, &FloatData);
|
|||
|
KiSetFloatRegisterValue( Operand1, FloatData,
|
|||
|
ExceptionFrame, TrapFrame );
|
|||
|
|
|||
|
EffectiveAddress = (PVOID)((ULONG_PTR)EffectiveAddress + Length);
|
|||
|
|
|||
|
//
|
|||
|
// emulate the 2nd half of the pair
|
|||
|
//
|
|||
|
|
|||
|
KiEmulateLoadFloat(EffectiveAddress, OpSize, &FloatData);
|
|||
|
KiSetFloatRegisterValue( Operand2,
|
|||
|
FloatData,
|
|||
|
ExceptionFrame,
|
|||
|
TrapFrame );
|
|||
|
|
|||
|
//
|
|||
|
// Update the address register (R3)
|
|||
|
//
|
|||
|
|
|||
|
Reg3Value = KiGetRegisterValue( Operand3,
|
|||
|
ExceptionFrame,
|
|||
|
TrapFrame );
|
|||
|
|
|||
|
//
|
|||
|
// immediate update form
|
|||
|
//
|
|||
|
|
|||
|
ImmValue = Length << 1;
|
|||
|
|
|||
|
Reg3Value = Reg3Value + ImmValue;
|
|||
|
|
|||
|
KiSetRegisterValue( Operand3, Reg3Value,
|
|||
|
ExceptionFrame, TrapFrame );
|
|||
|
|
|||
|
} else {
|
|||
|
|
|||
|
//
|
|||
|
// floating point single load
|
|||
|
//
|
|||
|
|
|||
|
if( PreviousMode != KernelMode ){
|
|||
|
|
|||
|
switch (OpSize) {
|
|||
|
case 0: Length = 16; break;
|
|||
|
case 1: Length = 8; break;
|
|||
|
case 2: Length = 4; break;
|
|||
|
case 3: Length = 8; break;
|
|||
|
default:
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
ProbeForRead( EffectiveAddress,
|
|||
|
Length,
|
|||
|
sizeof(UCHAR) );
|
|||
|
}
|
|||
|
KiEmulateLoadFloat(EffectiveAddress, OpSize, &FloatData);
|
|||
|
KiSetFloatRegisterValue( Operand1, FloatData,
|
|||
|
ExceptionFrame, TrapFrame );
|
|||
|
|
|||
|
//
|
|||
|
// Update the address register (R3)
|
|||
|
//
|
|||
|
|
|||
|
Reg3Value = KiGetRegisterValue( Operand3,
|
|||
|
ExceptionFrame,
|
|||
|
TrapFrame );
|
|||
|
|
|||
|
//
|
|||
|
// immediate update form
|
|||
|
//
|
|||
|
|
|||
|
ImmValue = (FaultInstruction.u.i_field.r2
|
|||
|
+ (FaultInstruction.u.i_field.x << 7));
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.m == 1) {
|
|||
|
|
|||
|
ImmValue = 0xFFFFFFFFFFFFFF00i64 | ImmValue;
|
|||
|
|
|||
|
}
|
|||
|
|
|||
|
Reg3Value = Reg3Value + ImmValue;
|
|||
|
|
|||
|
KiSetRegisterValue( Operand3, Reg3Value,
|
|||
|
ExceptionFrame, TrapFrame );
|
|||
|
}
|
|||
|
|
|||
|
break;
|
|||
|
|
|||
|
|
|||
|
case STREL_OP:
|
|||
|
|
|||
|
__mf();
|
|||
|
|
|||
|
case ST_OP:
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.x == 1) {
|
|||
|
|
|||
|
//
|
|||
|
// xField must be 0
|
|||
|
//
|
|||
|
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.m == 1) {
|
|||
|
|
|||
|
//
|
|||
|
// no register update form defined
|
|||
|
//
|
|||
|
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
if( PreviousMode != KernelMode ){
|
|||
|
ProbeForWrite( EffectiveAddress,
|
|||
|
1 << OpSize,
|
|||
|
sizeof(UCHAR) );
|
|||
|
}
|
|||
|
|
|||
|
Data = KiGetRegisterValue( Operand2, ExceptionFrame, TrapFrame );
|
|||
|
KiEmulateStore( EffectiveAddress, OpSize, &Data);
|
|||
|
|
|||
|
break;
|
|||
|
|
|||
|
case STREL_IMM_OP:
|
|||
|
|
|||
|
__mf();
|
|||
|
|
|||
|
case ST_IMM_OP:
|
|||
|
|
|||
|
if( PreviousMode != KernelMode ){
|
|||
|
ProbeForWrite( EffectiveAddress,
|
|||
|
1 << OpSize,
|
|||
|
sizeof(UCHAR) );
|
|||
|
}
|
|||
|
|
|||
|
Data = KiGetRegisterValue( Operand2, ExceptionFrame, TrapFrame );
|
|||
|
KiEmulateStore( EffectiveAddress, OpSize, &Data);
|
|||
|
|
|||
|
//
|
|||
|
// update the address register (R3)
|
|||
|
//
|
|||
|
|
|||
|
Reg3Value = KiGetRegisterValue(Operand3, ExceptionFrame, TrapFrame);
|
|||
|
|
|||
|
//
|
|||
|
// immediate update form
|
|||
|
//
|
|||
|
|
|||
|
ImmValue = (FaultInstruction.u.i_field.r1
|
|||
|
+ (FaultInstruction.u.i_field.x << 7));
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.m == 1) {
|
|||
|
|
|||
|
ImmValue = 0xFFFFFFFFFFFFFF00i64 | ImmValue;
|
|||
|
|
|||
|
}
|
|||
|
|
|||
|
Reg3Value = Reg3Value + ImmValue;
|
|||
|
|
|||
|
KiSetRegisterValue(Operand3, Reg3Value, ExceptionFrame, TrapFrame);
|
|||
|
|
|||
|
break;
|
|||
|
|
|||
|
|
|||
|
case STF_OP:
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.x) {
|
|||
|
|
|||
|
//
|
|||
|
// x field must be 0
|
|||
|
//
|
|||
|
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.m) {
|
|||
|
|
|||
|
//
|
|||
|
// no register update form defined
|
|||
|
//
|
|||
|
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
if( PreviousMode != KernelMode ){
|
|||
|
|
|||
|
switch (OpSize) {
|
|||
|
case 0: Length = 16; break;
|
|||
|
case 1: Length = 8; break;
|
|||
|
case 2: Length = 4; break;
|
|||
|
case 3: Length = 8; break;
|
|||
|
default:
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
ProbeForWrite( EffectiveAddress,
|
|||
|
Length,
|
|||
|
sizeof(UCHAR) );
|
|||
|
}
|
|||
|
|
|||
|
if (Operand2 >= 32) Operand2 = 32 + (Rrbfr + Operand2 - 32) % 96;
|
|||
|
FloatData = KiGetFloatRegisterValue(Operand2,
|
|||
|
ExceptionFrame,
|
|||
|
TrapFrame);
|
|||
|
KiEmulateStoreFloat( EffectiveAddress, OpSize, &FloatData);
|
|||
|
|
|||
|
break;
|
|||
|
|
|||
|
case STF_IMM_OP:
|
|||
|
|
|||
|
if( PreviousMode != KernelMode ){
|
|||
|
|
|||
|
switch (OpSize) {
|
|||
|
case 0: Length = 16; break;
|
|||
|
case 1: Length = 8; break;
|
|||
|
case 2: Length = 4; break;
|
|||
|
case 3: Length = 8; break;
|
|||
|
default:
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
ProbeForWrite( EffectiveAddress,
|
|||
|
Length,
|
|||
|
sizeof(UCHAR) );
|
|||
|
}
|
|||
|
|
|||
|
if (Operand2 >= 32) Operand2 = 32 + (Rrbfr + Operand2 - 32) % 96;
|
|||
|
FloatData = KiGetFloatRegisterValue(Operand2,
|
|||
|
ExceptionFrame,
|
|||
|
TrapFrame);
|
|||
|
KiEmulateStoreFloat( EffectiveAddress, OpSize, &FloatData);
|
|||
|
|
|||
|
//
|
|||
|
// update the address register (R3)
|
|||
|
//
|
|||
|
|
|||
|
if (Operand3 >= 32) Operand3 = 32 + (Rrbfr + Operand3 - 32) % 96;
|
|||
|
Reg3Value = KiGetRegisterValue(Operand3, ExceptionFrame, TrapFrame);
|
|||
|
|
|||
|
//
|
|||
|
// immediate update form
|
|||
|
//
|
|||
|
|
|||
|
ImmValue = (FaultInstruction.u.i_field.r1
|
|||
|
+ (FaultInstruction.u.i_field.x << 7));
|
|||
|
|
|||
|
if (FaultInstruction.u.i_field.m == 1) {
|
|||
|
|
|||
|
ImmValue = 0xFFFFFFFFFFFFFF00i64 | ImmValue;
|
|||
|
|
|||
|
}
|
|||
|
|
|||
|
Reg3Value = Reg3Value + ImmValue;
|
|||
|
|
|||
|
KiSetRegisterValue(Operand3, Reg3Value, ExceptionFrame, TrapFrame);
|
|||
|
|
|||
|
break;
|
|||
|
|
|||
|
default:
|
|||
|
|
|||
|
return FALSE;
|
|||
|
|
|||
|
}
|
|||
|
|
|||
|
//
|
|||
|
// advance instruction pointer
|
|||
|
//
|
|||
|
|
|||
|
KiAdvanceInstPointer(TrapFrame);
|
|||
|
|
|||
|
return TRUE;
|
|||
|
|
|||
|
//
|
|||
|
// If an exception occurs, then copy the new exception information to the
|
|||
|
// original exception record and handle the exception.
|
|||
|
//
|
|||
|
|
|||
|
} except (KiCopyInformation(ExceptionRecord,
|
|||
|
(GetExceptionInformation())->ExceptionRecord)) {
|
|||
|
|
|||
|
//
|
|||
|
// Preserve the original exception address.
|
|||
|
//
|
|||
|
|
|||
|
ExceptionRecord->ExceptionAddress = ExceptionAddress;
|
|||
|
}
|
|||
|
|
|||
|
//
|
|||
|
// Return a value of FALSE.
|
|||
|
//
|
|||
|
|
|||
|
return FALSE;
|
|||
|
}
|
|||
|
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateLoad(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
IN ULONG OperandSize,
|
|||
|
IN PVOID Data
|
|||
|
)
|
|||
|
|
|||
|
/*++
|
|||
|
|
|||
|
Routine Description:
|
|||
|
|
|||
|
This routine returns the integer value stored at the unaligned
|
|||
|
address passed in UnalignedAddress.
|
|||
|
|
|||
|
Arguments:
|
|||
|
|
|||
|
UnalignedAddress - Supplies a pointer to data value.
|
|||
|
|
|||
|
OperandSize - Supplies the size of data to be loaded
|
|||
|
|
|||
|
Data - Supplies a pointer to be filled for data
|
|||
|
|
|||
|
Return Value:
|
|||
|
|
|||
|
The value at the address pointed to by UnalignedAddress.
|
|||
|
|
|||
|
--*/
|
|||
|
|
|||
|
{
|
|||
|
PUCHAR Source;
|
|||
|
PUCHAR Destination;
|
|||
|
ULONG i;
|
|||
|
|
|||
|
Source = (PUCHAR) UnalignedAddress;
|
|||
|
Destination = (PUCHAR) Data;
|
|||
|
OperandSize = 1 << OperandSize;
|
|||
|
|
|||
|
for (i = 0; i < OperandSize; i++) {
|
|||
|
|
|||
|
*Destination++ = *Source++;
|
|||
|
|
|||
|
}
|
|||
|
|
|||
|
return;
|
|||
|
}
|
|||
|
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateStore(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
IN ULONG OperandSize,
|
|||
|
IN PVOID Data
|
|||
|
)
|
|||
|
/*++
|
|||
|
|
|||
|
Routine Description:
|
|||
|
|
|||
|
This routine store the integer value at the unaligned
|
|||
|
address passed in UnalignedAddress.
|
|||
|
|
|||
|
Arguments:
|
|||
|
|
|||
|
UnalignedAddress - Supplies a pointer to be stored
|
|||
|
|
|||
|
OperandSize - Supplies the size of data to be storeed
|
|||
|
|
|||
|
Data - Supplies a pointer to data value
|
|||
|
|
|||
|
Return Value:
|
|||
|
|
|||
|
The value at the address pointed to by UnalignedAddress.
|
|||
|
|
|||
|
--*/
|
|||
|
{
|
|||
|
PUCHAR Source;
|
|||
|
PUCHAR Destination;
|
|||
|
ULONG i;
|
|||
|
|
|||
|
Source = (PUCHAR) Data;
|
|||
|
Destination = (PUCHAR) UnalignedAddress;
|
|||
|
OperandSize = 1 << OperandSize;
|
|||
|
|
|||
|
for (i = 0; i < OperandSize; i++) {
|
|||
|
|
|||
|
*Destination++ = *Source++;
|
|||
|
|
|||
|
}
|
|||
|
|
|||
|
return;
|
|||
|
}
|
|||
|
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateLoadFloat(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
IN ULONG OperandSize,
|
|||
|
IN OUT PVOID Data
|
|||
|
)
|
|||
|
|
|||
|
/*++
|
|||
|
|
|||
|
Routine Description:
|
|||
|
|
|||
|
This routine returns the floating point value stored at the unaligned
|
|||
|
address passed in UnalignedAddress.
|
|||
|
|
|||
|
Arguments:
|
|||
|
|
|||
|
UnalignedAddress - Supplies a pointer to floating point data value.
|
|||
|
|
|||
|
OperandSize - Supplies the size of data to be loaded
|
|||
|
|
|||
|
Data - Supplies a pointer to be filled for data
|
|||
|
|
|||
|
Return Value:
|
|||
|
|
|||
|
The value at the address pointed to by UnalignedAddress.
|
|||
|
|
|||
|
--*/
|
|||
|
|
|||
|
{
|
|||
|
FLOAT128 FloatData;
|
|||
|
|
|||
|
RtlCopyMemory(&FloatData, UnalignedAddress, sizeof(FLOAT128));
|
|||
|
|
|||
|
switch (OperandSize) {
|
|||
|
|
|||
|
case 0:
|
|||
|
KiEmulateLoadFloat80(&FloatData, Data);
|
|||
|
return;
|
|||
|
|
|||
|
case 1:
|
|||
|
KiEmulateLoadFloatInt(&FloatData, Data);
|
|||
|
return;
|
|||
|
|
|||
|
case 2:
|
|||
|
KiEmulateLoadFloat32(&FloatData, Data);
|
|||
|
return;
|
|||
|
|
|||
|
case 3:
|
|||
|
KiEmulateLoadFloat64(&FloatData, Data);
|
|||
|
return;
|
|||
|
|
|||
|
default:
|
|||
|
return;
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
VOID
|
|||
|
KiEmulateStoreFloat(
|
|||
|
IN PVOID UnalignedAddress,
|
|||
|
IN ULONG OperandSize,
|
|||
|
IN PVOID Data
|
|||
|
)
|
|||
|
|
|||
|
/*++
|
|||
|
|
|||
|
Routine Description:
|
|||
|
|
|||
|
This routine stores the floating point value stored at the unaligned
|
|||
|
address passed in UnalignedAddress.
|
|||
|
|
|||
|
Arguments:
|
|||
|
|
|||
|
UnalignedAddress - Supplies a pointer to be stored.
|
|||
|
|
|||
|
OperandSize - Supplies the size of data to be loaded
|
|||
|
|
|||
|
Data - Supplies a pointer to floating point data
|
|||
|
|
|||
|
Return Value:
|
|||
|
|
|||
|
The value at the address pointed to by UnalignedAddress.
|
|||
|
|
|||
|
--*/
|
|||
|
|
|||
|
{
|
|||
|
FLOAT128 FloatData;
|
|||
|
ULONG Length;
|
|||
|
|
|||
|
switch (OperandSize) {
|
|||
|
|
|||
|
case 0:
|
|||
|
KiEmulateStoreFloat80(&FloatData, Data);
|
|||
|
Length = 10;
|
|||
|
break;
|
|||
|
|
|||
|
case 1:
|
|||
|
KiEmulateStoreFloatInt(&FloatData, Data);
|
|||
|
Length = 8;
|
|||
|
break;
|
|||
|
|
|||
|
case 2:
|
|||
|
KiEmulateStoreFloat32(&FloatData, Data);
|
|||
|
Length = 4;
|
|||
|
break;
|
|||
|
|
|||
|
case 3:
|
|||
|
KiEmulateStoreFloat64(&FloatData, Data);
|
|||
|
Length = 8;
|
|||
|
break;
|
|||
|
|
|||
|
default:
|
|||
|
return;
|
|||
|
}
|
|||
|
|
|||
|
RtlCopyMemory(UnalignedAddress, &FloatData, Length);
|
|||
|
}
|
|||
|
|