| 0,0 → 1,954 |
|---|
| /* |
| * Copyright 2006-2007 Advanced Micro Devices, Inc. |
| * |
| * Permission is hereby granted, free of charge, to any person obtaining a |
| * copy of this software and associated documentation files (the "Software"), |
| * to deal in the Software without restriction, including without limitation |
| * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
| * and/or sell copies of the Software, and to permit persons to whom the |
| * Software is furnished to do so, subject to the following conditions: |
| * |
| * The above copyright notice and this permission notice shall be included in |
| * all copies or substantial portions of the Software. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
| * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR |
| * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
| * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR |
| * OTHER DEALINGS IN THE SOFTWARE. |
| */ |
| |
| /** |
| |
| Module Name: |
| |
| CD_Operations.c |
| |
| Abstract: |
| |
| Functions Implementing Command Operations and other common functions |
| |
| Revision History: |
| |
| NEG:27.09.2002 Initiated. |
| --*/ |
| #define __SW_4 |
| |
| #include "Decoder.h" |
| #include "atombios.h" |
| |
| |
| |
| VOID PutDataRegister(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID PutDataPS(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID PutDataWS(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID PutDataFB(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID PutDataPLL(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID PutDataMC(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| |
| UINT32 GetParametersDirect32(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| UINT32 GetParametersDirect16(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| UINT32 GetParametersDirect8(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| |
| UINT32 GetParametersRegister(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| UINT32 GetParametersPS(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| UINT32 GetParametersWS(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| UINT32 GetParametersFB(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| UINT32 GetParametersPLL(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| UINT32 GetParametersMC(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| |
| VOID SkipParameters16(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID SkipParameters8(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| |
| UINT32 GetParametersIndirect(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| UINT32 GetParametersDirect(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| |
| UINT16* GetDataMasterTablePointer(DEVICE_DATA STACK_BASED* pDeviceData); |
| UINT8 GetTrueIndexInMasterTable(PARSER_TEMP_DATA STACK_BASED * pParserTempData, UINT8 IndexInMasterTable); |
| |
| |
| WRITE_IO_FUNCTION WritePCIFunctions[8] = { |
| WritePCIReg32, |
| WritePCIReg16, WritePCIReg16, WritePCIReg16, |
| WritePCIReg8,WritePCIReg8,WritePCIReg8,WritePCIReg8 |
| }; |
| WRITE_IO_FUNCTION WriteIOFunctions[8] = { |
| WriteSysIOReg32, |
| WriteSysIOReg16,WriteSysIOReg16,WriteSysIOReg16, |
| WriteSysIOReg8,WriteSysIOReg8,WriteSysIOReg8,WriteSysIOReg8 |
| }; |
| READ_IO_FUNCTION ReadPCIFunctions[8] = { |
| (READ_IO_FUNCTION)ReadPCIReg32, |
| (READ_IO_FUNCTION)ReadPCIReg16, |
| (READ_IO_FUNCTION)ReadPCIReg16, |
| (READ_IO_FUNCTION)ReadPCIReg16, |
| (READ_IO_FUNCTION)ReadPCIReg8, |
| (READ_IO_FUNCTION)ReadPCIReg8, |
| (READ_IO_FUNCTION)ReadPCIReg8, |
| (READ_IO_FUNCTION)ReadPCIReg8 |
| }; |
| READ_IO_FUNCTION ReadIOFunctions[8] = { |
| (READ_IO_FUNCTION)ReadSysIOReg32, |
| (READ_IO_FUNCTION)ReadSysIOReg16, |
| (READ_IO_FUNCTION)ReadSysIOReg16, |
| (READ_IO_FUNCTION)ReadSysIOReg16, |
| (READ_IO_FUNCTION)ReadSysIOReg8, |
| (READ_IO_FUNCTION)ReadSysIOReg8, |
| (READ_IO_FUNCTION)ReadSysIOReg8, |
| (READ_IO_FUNCTION)ReadSysIOReg8 |
| }; |
| READ_IO_FUNCTION GetParametersDirectArray[8]={ |
| GetParametersDirect32, |
| GetParametersDirect16,GetParametersDirect16,GetParametersDirect16, |
| GetParametersDirect8,GetParametersDirect8,GetParametersDirect8, |
| GetParametersDirect8 |
| }; |
| |
| COMMANDS_DECODER PutDataFunctions[6] = { |
| PutDataRegister, |
| PutDataPS, |
| PutDataWS, |
| PutDataFB, |
| PutDataPLL, |
| PutDataMC |
| }; |
| CD_GET_PARAMETERS GetDestination[6] = { |
| GetParametersRegister, |
| GetParametersPS, |
| GetParametersWS, |
| GetParametersFB, |
| GetParametersPLL, |
| GetParametersMC |
| }; |
| |
| COMMANDS_DECODER SkipDestination[6] = { |
| SkipParameters16, |
| SkipParameters8, |
| SkipParameters8, |
| SkipParameters8, |
| SkipParameters8, |
| SkipParameters8 |
| }; |
| |
| CD_GET_PARAMETERS GetSource[8] = { |
| GetParametersRegister, |
| GetParametersPS, |
| GetParametersWS, |
| GetParametersFB, |
| GetParametersIndirect, |
| GetParametersDirect, |
| GetParametersPLL, |
| GetParametersMC |
| }; |
| |
| UINT32 AlignmentMask[8] = {0xFFFFFFFF,0xFFFF,0xFFFF,0xFFFF,0xFF,0xFF,0xFF,0xFF}; |
| UINT8 SourceAlignmentShift[8] = {0,0,8,16,0,8,16,24}; |
| UINT8 DestinationAlignmentShift[4] = {0,8,16,24}; |
| |
| #define INDIRECTIO_ID 1 |
| #define INDIRECTIO_END_OF_ID 9 |
| |
| VOID IndirectIOCommand(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID IndirectIOCommand_MOVE(PARSER_TEMP_DATA STACK_BASED * pParserTempData, UINT32 temp); |
| VOID IndirectIOCommand_MOVE_INDEX(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID IndirectIOCommand_MOVE_ATTR(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID IndirectIOCommand_MOVE_DATA(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID IndirectIOCommand_SET(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| VOID IndirectIOCommand_CLEAR(PARSER_TEMP_DATA STACK_BASED * pParserTempData); |
| |
| |
| INDIRECT_IO_PARSER_COMMANDS IndirectIOParserCommands[10]={ |
| {IndirectIOCommand,1}, |
| {IndirectIOCommand,2}, |
| {ReadIndReg32,3}, |
| {WriteIndReg32,3}, |
| {IndirectIOCommand_CLEAR,3}, |
| {IndirectIOCommand_SET,3}, |
| {IndirectIOCommand_MOVE_INDEX,4}, |
| {IndirectIOCommand_MOVE_ATTR,4}, |
| {IndirectIOCommand_MOVE_DATA,4}, |
| {IndirectIOCommand,3} |
| }; |
| |
| |
| VOID IndirectIOCommand(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| } |
| |
| |
| VOID IndirectIOCommand_MOVE_INDEX(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->IndirectData &= ~((0xFFFFFFFF >> (32-pParserTempData->IndirectIOTablePointer[1])) << pParserTempData->IndirectIOTablePointer[3]); |
| pParserTempData->IndirectData |=(((pParserTempData->Index >> pParserTempData->IndirectIOTablePointer[2]) & |
| (0xFFFFFFFF >> (32-pParserTempData->IndirectIOTablePointer[1]))) << pParserTempData->IndirectIOTablePointer[3]); |
| } |
| |
| VOID IndirectIOCommand_MOVE_ATTR(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->IndirectData &= ~((0xFFFFFFFF >> (32-pParserTempData->IndirectIOTablePointer[1])) << pParserTempData->IndirectIOTablePointer[3]); |
| pParserTempData->IndirectData |=(((pParserTempData->AttributesData >> pParserTempData->IndirectIOTablePointer[2]) |
| & (0xFFFFFFFF >> (32-pParserTempData->IndirectIOTablePointer[1]))) << pParserTempData->IndirectIOTablePointer[3]); |
| } |
| |
| VOID IndirectIOCommand_MOVE_DATA(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->IndirectData &= ~((0xFFFFFFFF >> (32-pParserTempData->IndirectIOTablePointer[1])) << pParserTempData->IndirectIOTablePointer[3]); |
| pParserTempData->IndirectData |=(((pParserTempData->DestData32 >> pParserTempData->IndirectIOTablePointer[2]) |
| & (0xFFFFFFFF >> (32-pParserTempData->IndirectIOTablePointer[1]))) << pParserTempData->IndirectIOTablePointer[3]); |
| } |
| |
| |
| VOID IndirectIOCommand_SET(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->IndirectData |= ((0xFFFFFFFF >> (32-pParserTempData->IndirectIOTablePointer[1])) << pParserTempData->IndirectIOTablePointer[2]); |
| } |
| |
| VOID IndirectIOCommand_CLEAR(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->IndirectData &= ~((0xFFFFFFFF >> (32-pParserTempData->IndirectIOTablePointer[1])) << pParserTempData->IndirectIOTablePointer[2]); |
| } |
| |
| |
| UINT32 IndirectInputOutput(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| // if ((pParserTempData->IndirectData & 0x7f)==INDIRECT_IO_MM) pParserTempData->IndirectData|=pParserTempData->CurrentPortID; |
| // pParserTempData->IndirectIOTablePointer=pParserTempData->IndirectIOTable; |
| while (*pParserTempData->IndirectIOTablePointer) |
| { |
| if ((pParserTempData->IndirectIOTablePointer[0] == INDIRECTIO_ID) && |
| (pParserTempData->IndirectIOTablePointer[1] == pParserTempData->IndirectData)) |
| { |
| pParserTempData->IndirectIOTablePointer+=IndirectIOParserCommands[*pParserTempData->IndirectIOTablePointer].csize; |
| while (*pParserTempData->IndirectIOTablePointer != INDIRECTIO_END_OF_ID) |
| { |
| IndirectIOParserCommands[*pParserTempData->IndirectIOTablePointer].func(pParserTempData); |
| pParserTempData->IndirectIOTablePointer+=IndirectIOParserCommands[*pParserTempData->IndirectIOTablePointer].csize; |
| } |
| pParserTempData->IndirectIOTablePointer-=*(UINT16*)(pParserTempData->IndirectIOTablePointer+1); |
| pParserTempData->IndirectIOTablePointer++; |
| return pParserTempData->IndirectData; |
| } else pParserTempData->IndirectIOTablePointer+=IndirectIOParserCommands[*pParserTempData->IndirectIOTablePointer].csize; |
| } |
| return 0; |
| } |
| |
| |
| |
| VOID PutDataRegister(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=(UINT32)pParserTempData->pCmd->Parameters.WordXX.PA_Destination; |
| pParserTempData->Index+=pParserTempData->CurrentRegBlock; |
| switch(pParserTempData->Multipurpose.CurrentPort){ |
| case ATI_RegsPort: |
| if (pParserTempData->CurrentPortID == INDIRECT_IO_MM) |
| { |
| if (pParserTempData->Index==0) pParserTempData->DestData32 <<= 2; |
| WriteReg32( pParserTempData); |
| } else |
| { |
| pParserTempData->IndirectData=pParserTempData->CurrentPortID+INDIRECT_IO_WRITE; |
| IndirectInputOutput(pParserTempData); |
| } |
| break; |
| case PCI_Port: |
| WritePCIFunctions[pParserTempData->pCmd->Header.Attribute.SourceAlignment](pParserTempData); |
| break; |
| case SystemIO_Port: |
| WriteIOFunctions[pParserTempData->pCmd->Header.Attribute.SourceAlignment](pParserTempData); |
| break; |
| } |
| } |
| |
| VOID PutDataPS(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| *(pParserTempData->pDeviceData->pParameterSpace+pParserTempData->pCmd->Parameters.ByteXX.PA_Destination)= |
| pParserTempData->DestData32; |
| } |
| |
| VOID PutDataWS(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| if (pParserTempData->pCmd->Parameters.ByteXX.PA_Destination < WS_QUOTIENT_C) |
| *(pParserTempData->pWorkingTableData->pWorkSpace+pParserTempData->pCmd->Parameters.ByteXX.PA_Destination) = pParserTempData->DestData32; |
| else |
| switch (pParserTempData->pCmd->Parameters.ByteXX.PA_Destination) |
| { |
| case WS_REMINDER_C: |
| pParserTempData->MultiplicationOrDivision.Division.Reminder32=pParserTempData->DestData32; |
| break; |
| case WS_QUOTIENT_C: |
| pParserTempData->MultiplicationOrDivision.Division.Quotient32=pParserTempData->DestData32; |
| break; |
| case WS_DATAPTR_C: |
| #ifndef UEFI_BUILD |
| pParserTempData->CurrentDataBlock=(UINT16)pParserTempData->DestData32; |
| #else |
| pParserTempData->CurrentDataBlock=(UINTN)pParserTempData->DestData32; |
| #endif |
| break; |
| case WS_SHIFT_C: |
| pParserTempData->Shift2MaskConverter=(UINT8)pParserTempData->DestData32; |
| break; |
| case WS_FB_WINDOW_C: |
| pParserTempData->CurrentFB_Window=pParserTempData->DestData32; |
| break; |
| case WS_ATTRIBUTES_C: |
| pParserTempData->AttributesData=(UINT16)pParserTempData->DestData32; |
| break; |
| } |
| |
| } |
| |
| VOID PutDataFB(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=(UINT32)pParserTempData->pCmd->Parameters.ByteXX.PA_Destination; |
| //Make an Index from address first, then add to the Index |
| pParserTempData->Index+=(pParserTempData->CurrentFB_Window>>2); |
| WriteFrameBuffer32(pParserTempData); |
| } |
| |
| VOID PutDataPLL(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=(UINT32)pParserTempData->pCmd->Parameters.ByteXX.PA_Destination; |
| WritePLL32( pParserTempData ); |
| } |
| |
| VOID PutDataMC(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=(UINT32)pParserTempData->pCmd->Parameters.ByteXX.PA_Destination; |
| WriteMC32( pParserTempData ); |
| } |
| |
| |
| VOID SkipParameters8(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT8); |
| } |
| |
| VOID SkipParameters16(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT16); |
| } |
| |
| |
| UINT32 GetParametersRegister(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=*(UINT16*)pParserTempData->pWorkingTableData->IP; |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT16); |
| pParserTempData->Index+=pParserTempData->CurrentRegBlock; |
| switch(pParserTempData->Multipurpose.CurrentPort) |
| { |
| case PCI_Port: |
| return ReadPCIFunctions[pParserTempData->pCmd->Header.Attribute.SourceAlignment](pParserTempData); |
| case SystemIO_Port: |
| return ReadIOFunctions[pParserTempData->pCmd->Header.Attribute.SourceAlignment](pParserTempData); |
| case ATI_RegsPort: |
| default: |
| if (pParserTempData->CurrentPortID == INDIRECT_IO_MM) return ReadReg32( pParserTempData ); |
| else |
| { |
| pParserTempData->IndirectData=pParserTempData->CurrentPortID+INDIRECT_IO_READ; |
| return IndirectInputOutput(pParserTempData); |
| } |
| } |
| } |
| |
| UINT32 GetParametersPS(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=*pParserTempData->pWorkingTableData->IP; |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT8); |
| return *(pParserTempData->pDeviceData->pParameterSpace+pParserTempData->Index); |
| } |
| |
| UINT32 GetParametersWS(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=*pParserTempData->pWorkingTableData->IP; |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT8); |
| if (pParserTempData->Index < WS_QUOTIENT_C) |
| return *(pParserTempData->pWorkingTableData->pWorkSpace+pParserTempData->Index); |
| else |
| switch (pParserTempData->Index) |
| { |
| case WS_REMINDER_C: |
| return pParserTempData->MultiplicationOrDivision.Division.Reminder32; |
| case WS_QUOTIENT_C: |
| return pParserTempData->MultiplicationOrDivision.Division.Quotient32; |
| case WS_DATAPTR_C: |
| return (UINT32)pParserTempData->CurrentDataBlock; |
| case WS_OR_MASK_C: |
| return ((UINT32)1) << pParserTempData->Shift2MaskConverter; |
| case WS_AND_MASK_C: |
| return ~(((UINT32)1) << pParserTempData->Shift2MaskConverter); |
| case WS_FB_WINDOW_C: |
| return pParserTempData->CurrentFB_Window; |
| case WS_ATTRIBUTES_C: |
| return pParserTempData->AttributesData; |
| } |
| return 0; |
| |
| } |
| |
| UINT32 GetParametersFB(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=*pParserTempData->pWorkingTableData->IP; |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT8); |
| pParserTempData->Index+=(pParserTempData->CurrentFB_Window>>2); |
| return ReadFrameBuffer32(pParserTempData); |
| } |
| |
| UINT32 GetParametersPLL(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=*pParserTempData->pWorkingTableData->IP; |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT8); |
| return ReadPLL32( pParserTempData ); |
| } |
| |
| UINT32 GetParametersMC(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=*pParserTempData->pWorkingTableData->IP; |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT8); |
| return ReadMC32( pParserTempData ); |
| } |
| |
| |
| UINT32 GetParametersIndirect(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->Index=*(UINT16*)pParserTempData->pWorkingTableData->IP; |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT16); |
| return *(UINT32*)(RELATIVE_TO_BIOS_IMAGE(pParserTempData->Index)+pParserTempData->CurrentDataBlock); |
| } |
| |
| UINT32 GetParametersDirect8(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->CD_Mask.SrcAlignment=alignmentByte0; |
| pParserTempData->Index=*(UINT8*)pParserTempData->pWorkingTableData->IP; |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT8); |
| return pParserTempData->Index; |
| } |
| |
| UINT32 GetParametersDirect16(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->CD_Mask.SrcAlignment=alignmentLowerWord; |
| pParserTempData->Index=*(UINT16*)pParserTempData->pWorkingTableData->IP; |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT16); |
| return pParserTempData->Index; |
| } |
| |
| UINT32 GetParametersDirect32(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->CD_Mask.SrcAlignment=alignmentDword; |
| pParserTempData->Index=*(UINT32*)pParserTempData->pWorkingTableData->IP; |
| pParserTempData->pWorkingTableData->IP+=sizeof(UINT32); |
| return pParserTempData->Index; |
| } |
| |
| |
| UINT32 GetParametersDirect(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| return GetParametersDirectArray[pParserTempData->pCmd->Header.Attribute.SourceAlignment](pParserTempData); |
| } |
| |
| |
| VOID CommonSourceDataTransformation(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->SourceData32 >>= SourceAlignmentShift[pParserTempData->CD_Mask.SrcAlignment]; |
| pParserTempData->SourceData32 &= AlignmentMask[pParserTempData->CD_Mask.SrcAlignment]; |
| pParserTempData->SourceData32 <<= DestinationAlignmentShift[pParserTempData->CD_Mask.DestAlignment]; |
| } |
| |
| VOID CommonOperationDataTransformation(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->SourceData32 >>= SourceAlignmentShift[pParserTempData->CD_Mask.SrcAlignment]; |
| pParserTempData->SourceData32 &= AlignmentMask[pParserTempData->CD_Mask.SrcAlignment]; |
| pParserTempData->DestData32 >>= DestinationAlignmentShift[pParserTempData->CD_Mask.DestAlignment]; |
| pParserTempData->DestData32 &= AlignmentMask[pParserTempData->CD_Mask.SrcAlignment]; |
| } |
| |
| VOID ProcessMove(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| if (pParserTempData->CD_Mask.SrcAlignment!=alignmentDword) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| } else |
| { |
| SkipDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| } |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| |
| if (pParserTempData->CD_Mask.SrcAlignment!=alignmentDword) |
| { |
| pParserTempData->DestData32 &= ~(AlignmentMask[pParserTempData->CD_Mask.SrcAlignment] << DestinationAlignmentShift[pParserTempData->CD_Mask.DestAlignment]); |
| CommonSourceDataTransformation(pParserTempData); |
| pParserTempData->DestData32 |= pParserTempData->SourceData32; |
| } else |
| { |
| pParserTempData->DestData32=pParserTempData->SourceData32; |
| } |
| PutDataFunctions[pParserTempData->ParametersType.Destination](pParserTempData); |
| } |
| |
| VOID ProcessMask(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetParametersDirect(pParserTempData); |
| pParserTempData->Index=GetParametersDirect(pParserTempData); |
| pParserTempData->SourceData32 <<= DestinationAlignmentShift[pParserTempData->CD_Mask.DestAlignment]; |
| pParserTempData->SourceData32 |= ~(AlignmentMask[pParserTempData->CD_Mask.SrcAlignment] << DestinationAlignmentShift[pParserTempData->CD_Mask.DestAlignment]); |
| pParserTempData->DestData32 &= pParserTempData->SourceData32; |
| pParserTempData->Index &= AlignmentMask[pParserTempData->CD_Mask.SrcAlignment]; |
| pParserTempData->Index <<= DestinationAlignmentShift[pParserTempData->CD_Mask.DestAlignment]; |
| pParserTempData->DestData32 |= pParserTempData->Index; |
| PutDataFunctions[pParserTempData->ParametersType.Destination](pParserTempData); |
| } |
| |
| VOID ProcessAnd(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| pParserTempData->SourceData32 >>= SourceAlignmentShift[pParserTempData->CD_Mask.SrcAlignment]; |
| pParserTempData->SourceData32 <<= DestinationAlignmentShift[pParserTempData->CD_Mask.DestAlignment]; |
| pParserTempData->SourceData32 |= ~(AlignmentMask[pParserTempData->CD_Mask.SrcAlignment] << DestinationAlignmentShift[pParserTempData->CD_Mask.DestAlignment]); |
| pParserTempData->DestData32 &= pParserTempData->SourceData32; |
| PutDataFunctions[pParserTempData->ParametersType.Destination](pParserTempData); |
| } |
| |
| VOID ProcessOr(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| CommonSourceDataTransformation(pParserTempData); |
| pParserTempData->DestData32 |= pParserTempData->SourceData32; |
| PutDataFunctions[pParserTempData->ParametersType.Destination](pParserTempData); |
| } |
| |
| VOID ProcessXor(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| CommonSourceDataTransformation(pParserTempData); |
| pParserTempData->DestData32 ^= pParserTempData->SourceData32; |
| PutDataFunctions[pParserTempData->ParametersType.Destination](pParserTempData); |
| } |
| |
| VOID ProcessShl(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| CommonSourceDataTransformation(pParserTempData); |
| pParserTempData->DestData32 <<= pParserTempData->SourceData32; |
| PutDataFunctions[pParserTempData->ParametersType.Destination](pParserTempData); |
| } |
| |
| VOID ProcessShr(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| CommonSourceDataTransformation(pParserTempData); |
| pParserTempData->DestData32 >>= pParserTempData->SourceData32; |
| PutDataFunctions[pParserTempData->ParametersType.Destination](pParserTempData); |
| } |
| |
| |
| VOID ProcessADD(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| CommonSourceDataTransformation(pParserTempData); |
| pParserTempData->DestData32 += pParserTempData->SourceData32; |
| PutDataFunctions[pParserTempData->ParametersType.Destination](pParserTempData); |
| } |
| |
| VOID ProcessSUB(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| CommonSourceDataTransformation(pParserTempData); |
| pParserTempData->DestData32 -= pParserTempData->SourceData32; |
| PutDataFunctions[pParserTempData->ParametersType.Destination](pParserTempData); |
| } |
| |
| VOID ProcessMUL(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| CommonOperationDataTransformation(pParserTempData); |
| pParserTempData->MultiplicationOrDivision.Multiplication.Low32Bit=pParserTempData->DestData32 * pParserTempData->SourceData32; |
| } |
| |
| VOID ProcessDIV(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| |
| CommonOperationDataTransformation(pParserTempData); |
| pParserTempData->MultiplicationOrDivision.Division.Quotient32= |
| pParserTempData->DestData32 / pParserTempData->SourceData32; |
| pParserTempData->MultiplicationOrDivision.Division.Reminder32= |
| pParserTempData->DestData32 % pParserTempData->SourceData32; |
| } |
| |
| |
| VOID ProcessCompare(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->SourceData32=GetSource[pParserTempData->ParametersType.Source](pParserTempData); |
| |
| CommonOperationDataTransformation(pParserTempData); |
| |
| // Here we just set flags based on evaluation |
| if (pParserTempData->DestData32==pParserTempData->SourceData32) |
| pParserTempData->CompareFlags = Equal; |
| else |
| pParserTempData->CompareFlags = |
| (UINT8)((pParserTempData->DestData32<pParserTempData->SourceData32) ? Below : Above); |
| |
| } |
| |
| VOID ProcessClear(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| pParserTempData->DestData32=GetDestination[pParserTempData->ParametersType.Destination](pParserTempData); |
| pParserTempData->DestData32 &= ~(AlignmentMask[pParserTempData->CD_Mask.SrcAlignment] << SourceAlignmentShift[pParserTempData->CD_Mask.SrcAlignment]); |
| PutDataFunctions[pParserTempData->ParametersType.Destination](pParserTempData); |
| |
| } |
| |
| VOID ProcessShift(PARSER_TEMP_DATA STACK_BASED * pParserTempData) |
| { |
| UINT32 mask = AlignmentMask[pParserTempData->CD_Mask.SrcAlignment] << SourceAlignmentShift[pParserTempData->CD_Mask.SrcAlignment]; |
|