From 44901038400900dcf6affecf1f103ed8e026d0b6 Mon Sep 17 00:00:00 2001 From: Aleksandar Andrejevic Date: Sun, 29 Sep 2013 18:39:59 +0000 Subject: [PATCH] [SOFT386] Implement opcode group 0xD0 (instructions ROL, ROR, RCL, RCR, SHL, SHR, SAL, SAR). svn path=/branches/ntvdm/; revision=60455 --- lib/soft386/opgroups.c | 130 ++++++++++++++++++++++++++++++++++++++++- 1 file changed, 128 insertions(+), 2 deletions(-) diff --git a/lib/soft386/opgroups.c b/lib/soft386/opgroups.c index 52afb624478..254b69e2270 100644 --- a/lib/soft386/opgroups.c +++ b/lib/soft386/opgroups.c @@ -347,8 +347,134 @@ SOFT386_OPCODE_HANDLER(Soft386OpcodeGroupC7) SOFT386_OPCODE_HANDLER(Soft386OpcodeGroupD0) { - UNIMPLEMENTED; - return FALSE; // TODO: NOT IMPLEMENTED + UCHAR Result, Dummy, Value; + SOFT386_MOD_REG_RM ModRegRm; + BOOLEAN AddressSize = State->SegmentRegs[SOFT386_REG_CS].Size; + + if (State->PrefixFlags & SOFT386_PREFIX_ADSIZE) + { + /* The ADSIZE prefix toggles the size */ + AddressSize = !AddressSize; + } + + if (!Soft386ParseModRegRm(State, AddressSize, &ModRegRm)) + { + /* Exception occurred */ + return FALSE; + } + + /* Read the operands */ + if (!Soft386ReadModrmByteOperands(State, &ModRegRm, &Dummy, &Value)) + { + /* Exception occurred */ + return FALSE; + } + + /* Check which operation is this */ + switch (ModRegRm.Register) + { + /* ROL */ + case 0: + { + Result = (Value << 1) | (Value >> 7); + + /* Update CF and OF */ + State->Flags.Cf = Value >> 7; + State->Flags.Of = ((Result & SIGN_FLAG_BYTE) ? TRUE : FALSE) + ^ (State->Flags.Cf ? TRUE : FALSE); + + break; + } + + /* ROR */ + case 1: + { + Result = (Value >> 1) | (Value << 7); + + /* Update CF and OF */ + State->Flags.Cf = Value & 1; + State->Flags.Of = ((Result & SIGN_FLAG_BYTE) ? TRUE : FALSE) + ^ ((Result & (SIGN_FLAG_BYTE >> 1)) ? TRUE : FALSE); + + break; + } + + /* RCL */ + case 2: + { + Result = (Value << 1) | (State->Flags.Cf ? 1 : 0); + + /* Update CF and OF */ + State->Flags.Cf = (Value & SIGN_FLAG_BYTE) ? TRUE : FALSE; + State->Flags.Of = ((Result & SIGN_FLAG_BYTE) ? TRUE : FALSE) + ^ (State->Flags.Cf ? TRUE : FALSE); + + break; + } + + /* RCR */ + case 3: + { + Result = (Value >> 1) | (State->Flags.Cf ? SIGN_FLAG_BYTE : 0); + + /* Update CF and OF */ + State->Flags.Cf = Value & 1; + State->Flags.Of = ((Result & SIGN_FLAG_BYTE) ? TRUE : FALSE) + ^ ((Result & (SIGN_FLAG_BYTE >> 1)) ? TRUE : FALSE); + + break; + } + + /* SHL/SAL */ + case 4: + case 6: + { + Result = Value << 1; + + /* Update CF and OF */ + State->Flags.Cf = (Value & SIGN_FLAG_BYTE) ? TRUE : FALSE; + State->Flags.Of = ((Result & SIGN_FLAG_BYTE) ? TRUE : FALSE) + ^ (State->Flags.Cf ? TRUE : FALSE); + + break; + } + + /* SHR */ + case 5: + { + Result = Value >> 1; + + /* Update CF and OF */ + State->Flags.Cf = Value & 1; + State->Flags.Of = (Value & SIGN_FLAG_BYTE) ? TRUE : FALSE; + + break; + } + + /* SAR */ + case 7: + { + Result = (Value >> 1) | (Value & SIGN_FLAG_BYTE); + + /* Update CF and OF */ + State->Flags.Cf = Value & 1; + State->Flags.Of = FALSE; + + break; + } + } + + /* Update ZF, SF and PF */ + State->Flags.Zf = (Result == 0) ? TRUE : FALSE; + State->Flags.Sf = (Result & SIGN_FLAG_BYTE) ? TRUE : FALSE; + State->Flags.Pf = Soft386CalculateParity(Result); + + /* Write back the result */ + return Soft386WriteModrmByteOperands(State, + &ModRegRm, + FALSE, + Value); + } SOFT386_OPCODE_HANDLER(Soft386OpcodeGroupD1)