/* The copyright in this software is being made available under the BSD * License, included below. This software may be subject to other third party * and contributor rights, including patent rights, and no such rights are * granted under this license. * * Copyright (c) 2010-2012, ITU/ISO/IEC * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * * Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * * Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * * Neither the name of the ITU/ISO/IEC nor the names of its contributors may * be used to endorse or promote products derived from this software without * specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF * THE POSSIBILITY OF SUCH DAMAGE. */ /** \file TComRdCost.cpp \brief RD cost computation class */ #include #include #include "TComRom.h" #include "TComRdCost.h" #include "TComDataCU.h" //! \ingroup TLibCommon //! \{ #if SAIT_VSO_EST_A0033 Double TComRdCost::m_dDisparityCoeff = 1.0; #endif TComRdCost::TComRdCost() { init(); } TComRdCost::~TComRdCost() { #if !FIX203 xUninit(); #endif } // Calculate RD functions Double TComRdCost::calcRdCost( UInt uiBits, UInt uiDistortion, Bool bFlag, DFunc eDFunc ) { Double dRdCost = 0.0; Double dLambda = 0.0; switch ( eDFunc ) { case DF_SSE: assert(0); break; case DF_SAD: dLambda = (Double)m_uiLambdaMotionSAD; break; case DF_DEFAULT: dLambda = m_dLambda; break; case DF_SSE_FRAME: dLambda = m_dFrameLambda; break; default: assert (0); break; } #if HHI_INTERVIEW_SKIP_LAMBDA_SCALE dLambda = m_dLambdaScale * dLambda ; #endif if (bFlag) { // Intra8x8, Intra4x4 Block only... #if LOSSLESS_CODING && SEQUENCE_LEVEL_LOSSLESS dRdCost = (Double)(uiBits); #else dRdCost = (((Double)uiDistortion) + ((Double)uiBits * dLambda)); #endif } else { if (eDFunc == DF_SAD) { dRdCost = ((Double)uiDistortion + (Double)((Int)(uiBits * dLambda+.5)>>16)); dRdCost = (Double)(UInt)floor(dRdCost); } else { #if LOSSLESS_CODING && SEQUENCE_LEVEL_LOSSLESS dRdCost = (Double)(uiBits); #else dRdCost = ((Double)uiDistortion + (Double)((Int)(uiBits * dLambda+.5))); dRdCost = (Double)(UInt)floor(dRdCost); #endif } } return dRdCost; } Double TComRdCost::calcRdCost64( UInt64 uiBits, UInt64 uiDistortion, Bool bFlag, DFunc eDFunc ) { Double dRdCost = 0.0; Double dLambda = 0.0; switch ( eDFunc ) { case DF_SSE: assert(0); break; case DF_SAD: dLambda = (Double)m_uiLambdaMotionSAD; break; case DF_DEFAULT: dLambda = m_dLambda; break; case DF_SSE_FRAME: dLambda = m_dFrameLambda; break; default: assert (0); break; } if (bFlag) { // Intra8x8, Intra4x4 Block only... #if LOSSLESS_CODING && SEQUENCE_LEVEL_LOSSLESS dRdCost = (Double)(uiBits); #else dRdCost = (((Double)(Int64)uiDistortion) + ((Double)(Int64)uiBits * dLambda)); #endif } else { if (eDFunc == DF_SAD) { dRdCost = ((Double)(Int64)uiDistortion + (Double)((Int)((Int64)uiBits * dLambda+.5)>>16)); dRdCost = (Double)(UInt)floor(dRdCost); } else { #if LOSSLESS_CODING && SEQUENCE_LEVEL_LOSSLESS dRdCost = (Double)(uiBits); #else dRdCost = ((Double)(Int64)uiDistortion + (Double)((Int)((Int64)uiBits * dLambda+.5))); dRdCost = (Double)(UInt)floor(dRdCost); #endif } } return dRdCost; } Void TComRdCost::setLambda( Double dLambda ) { m_dLambda = dLambda; m_sqrtLambda = sqrt(m_dLambda); m_uiLambdaMotionSAD = (UInt)floor(65536.0 * m_sqrtLambda); m_uiLambdaMotionSSE = (UInt)floor(65536.0 * m_dLambda ); } #if H3D_IVMP Void TComRdCost::setLambdaMVReg( Double dLambda ) { m_uiLambdaMVRegSAD = (UInt)floor( 65536.0 * sqrt( dLambda ) ); m_uiLambdaMVRegSSE = (UInt)floor( 65536.0 * dLambda ); } #endif // Initalize Function Pointer by [eDFunc] Void TComRdCost::init() { m_afpDistortFunc[0] = NULL; // for DF_DEFAULT m_afpDistortFunc[1] = TComRdCost::xGetSSE; m_afpDistortFunc[2] = TComRdCost::xGetSSE4; m_afpDistortFunc[3] = TComRdCost::xGetSSE8; m_afpDistortFunc[4] = TComRdCost::xGetSSE16; m_afpDistortFunc[5] = TComRdCost::xGetSSE32; m_afpDistortFunc[6] = TComRdCost::xGetSSE64; m_afpDistortFunc[7] = TComRdCost::xGetSSE16N; m_afpDistortFunc[8] = TComRdCost::xGetSAD; m_afpDistortFunc[9] = TComRdCost::xGetSAD4; m_afpDistortFunc[10] = TComRdCost::xGetSAD8; m_afpDistortFunc[11] = TComRdCost::xGetSAD16; m_afpDistortFunc[12] = TComRdCost::xGetSAD32; m_afpDistortFunc[13] = TComRdCost::xGetSAD64; m_afpDistortFunc[14] = TComRdCost::xGetSAD16N; m_afpDistortFunc[15] = TComRdCost::xGetSAD; m_afpDistortFunc[16] = TComRdCost::xGetSAD4; m_afpDistortFunc[17] = TComRdCost::xGetSAD8; m_afpDistortFunc[18] = TComRdCost::xGetSAD16; m_afpDistortFunc[19] = TComRdCost::xGetSAD32; m_afpDistortFunc[20] = TComRdCost::xGetSAD64; m_afpDistortFunc[21] = TComRdCost::xGetSAD16N; #if AMP_SAD m_afpDistortFunc[43] = TComRdCost::xGetSAD12; m_afpDistortFunc[44] = TComRdCost::xGetSAD24; m_afpDistortFunc[45] = TComRdCost::xGetSAD48; m_afpDistortFunc[46] = TComRdCost::xGetSAD12; m_afpDistortFunc[47] = TComRdCost::xGetSAD24; m_afpDistortFunc[48] = TComRdCost::xGetSAD48; #endif m_afpDistortFunc[22] = TComRdCost::xGetHADs; m_afpDistortFunc[23] = TComRdCost::xGetHADs; m_afpDistortFunc[24] = TComRdCost::xGetHADs; m_afpDistortFunc[25] = TComRdCost::xGetHADs; m_afpDistortFunc[26] = TComRdCost::xGetHADs; m_afpDistortFunc[27] = TComRdCost::xGetHADs; m_afpDistortFunc[28] = TComRdCost::xGetHADs; #if SAIT_VSO_EST_A0033 m_afpDistortFunc[29] = TComRdCost::xGetVSD; m_afpDistortFunc[30] = TComRdCost::xGetVSD4; m_afpDistortFunc[31] = TComRdCost::xGetVSD8; m_afpDistortFunc[32] = TComRdCost::xGetVSD16; m_afpDistortFunc[33] = TComRdCost::xGetVSD32; m_afpDistortFunc[34] = TComRdCost::xGetVSD64; m_afpDistortFunc[35] = TComRdCost::xGetVSD16N; #endif #if !FIX203 m_puiComponentCostOriginP = NULL; m_puiComponentCost = NULL; m_puiVerCost = NULL; m_puiHorCost = NULL; #endif m_uiCost = 0; m_iCostScale = 0; #if !FIX203 m_iSearchLimit = 0xdeaddead; #if HHI_VSO m_apRefPics = NULL; m_paaiShiftLUTs = NULL; m_uiNumberRefPics = 0; m_bUseVSO = false; #if SAIT_VSO_EST_A0033 m_bUseEstimatedVSD = false; #endif m_uiVSOMode = 0; m_fpDistortFuncVSO = NULL; m_pcRenModel = NULL; #endif #if HHI_INTERVIEW_SKIP_LAMBDA_SCALE m_dLambdaScale = 1; #endif #endif } #if !FIX203 Void TComRdCost::initRateDistortionModel( Int iSubPelSearchLimit ) { // make it larger iSubPelSearchLimit += 4; iSubPelSearchLimit *= 8; if( m_iSearchLimit != iSubPelSearchLimit ) { xUninit(); m_iSearchLimit = iSubPelSearchLimit; m_puiComponentCostOriginP = new UInt[ 4 * iSubPelSearchLimit ]; m_puiMultiviewRegCostHorOrgP = new UInt[ 4 * iSubPelSearchLimit ]; m_puiMultiviewRegCostVerOrgP = new UInt[ 4 * iSubPelSearchLimit ]; iSubPelSearchLimit *= 2; m_puiComponentCost = m_puiComponentCostOriginP + iSubPelSearchLimit; m_puiMultiviewRegCostHor = m_puiMultiviewRegCostHorOrgP + iSubPelSearchLimit; m_puiMultiviewRegCostVer = m_puiMultiviewRegCostVerOrgP + iSubPelSearchLimit; for( Int n = -iSubPelSearchLimit; n < iSubPelSearchLimit; n++) { m_puiComponentCost[n] = xGetComponentBits( n ); m_puiMultiviewRegCostHor[n] = xGetComponentBits( n ); // first version m_puiMultiviewRegCostVer[n] = xGetComponentBits( n ); // first version } } } Void TComRdCost::xUninit() { if( NULL != m_puiComponentCostOriginP ) { delete [] m_puiComponentCostOriginP; m_puiComponentCostOriginP = NULL; } if( m_puiMultiviewRegCostHorOrgP ) { delete [] m_puiMultiviewRegCostHorOrgP; m_puiMultiviewRegCostHorOrgP = NULL; } if( m_puiMultiviewRegCostVerOrgP ) { delete [] m_puiMultiviewRegCostVerOrgP; m_puiMultiviewRegCostVerOrgP = NULL; } } #endif UInt TComRdCost::xGetComponentBits( Int iVal ) { UInt uiLength = 1; UInt uiTemp = ( iVal <= 0) ? (-iVal<<1)+1: (iVal<<1); assert ( uiTemp ); while ( 1 != uiTemp ) { uiTemp >>= 1; uiLength += 2; } return uiLength; } Void TComRdCost::setDistParam( UInt uiBlkWidth, UInt uiBlkHeight, DFunc eDFunc, DistParam& rcDistParam ) { // set Block Width / Height rcDistParam.iCols = uiBlkWidth; rcDistParam.iRows = uiBlkHeight; rcDistParam.DistFunc = m_afpDistortFunc[eDFunc + g_aucConvertToBit[ rcDistParam.iCols ] + 1 ]; // initialize rcDistParam.iSubShift = 0; #if HHI_INTERVIEW_SKIP rcDistParam.pUsed = 0; rcDistParam.iStrideUsed = 0; #endif } // Setting the Distortion Parameter for Inter (ME) Void TComRdCost::setDistParam( TComPattern* pcPatternKey, Pel* piRefY, Int iRefStride, DistParam& rcDistParam ) { // set Original & Curr Pointer / Stride rcDistParam.pOrg = pcPatternKey->getROIY(); rcDistParam.pCur = piRefY; rcDistParam.iStrideOrg = pcPatternKey->getPatternLStride(); rcDistParam.iStrideCur = iRefStride; // set Block Width / Height rcDistParam.iCols = pcPatternKey->getROIYWidth(); rcDistParam.iRows = pcPatternKey->getROIYHeight(); rcDistParam.DistFunc = m_afpDistortFunc[DF_SAD + g_aucConvertToBit[ rcDistParam.iCols ] + 1 ]; #if AMP_SAD if (rcDistParam.iCols == 12) { rcDistParam.DistFunc = m_afpDistortFunc[43 ]; } else if (rcDistParam.iCols == 24) { rcDistParam.DistFunc = m_afpDistortFunc[44 ]; } else if (rcDistParam.iCols == 48) { rcDistParam.DistFunc = m_afpDistortFunc[45 ]; } #endif // initialize rcDistParam.iSubShift = 0; #if HHI_INTERVIEW_SKIP rcDistParam.pUsed = 0; rcDistParam.iStrideUsed = 0; #endif } // Setting the Distortion Parameter for Inter (subpel ME with step) #if NS_HAD Void TComRdCost::setDistParam( TComPattern* pcPatternKey, Pel* piRefY, Int iRefStride, Int iStep, DistParam& rcDistParam, Bool bHADME, Bool bUseNSHAD ) #else Void TComRdCost::setDistParam( TComPattern* pcPatternKey, Pel* piRefY, Int iRefStride, Int iStep, DistParam& rcDistParam, Bool bHADME ) #endif { // set Original & Curr Pointer / Stride rcDistParam.pOrg = pcPatternKey->getROIY(); rcDistParam.pCur = piRefY; rcDistParam.iStrideOrg = pcPatternKey->getPatternLStride(); rcDistParam.iStrideCur = iRefStride * iStep; // set Step for interpolated buffer rcDistParam.iStep = iStep; // set Block Width / Height rcDistParam.iCols = pcPatternKey->getROIYWidth(); rcDistParam.iRows = pcPatternKey->getROIYHeight(); #if NS_HAD rcDistParam.bUseNSHAD = bUseNSHAD; #endif // set distortion function if ( !bHADME ) { rcDistParam.DistFunc = m_afpDistortFunc[DF_SADS + g_aucConvertToBit[ rcDistParam.iCols ] + 1 ]; #if AMP_SAD if (rcDistParam.iCols == 12) { rcDistParam.DistFunc = m_afpDistortFunc[46 ]; } else if (rcDistParam.iCols == 24) { rcDistParam.DistFunc = m_afpDistortFunc[47 ]; } else if (rcDistParam.iCols == 48) { rcDistParam.DistFunc = m_afpDistortFunc[48 ]; } #endif } else { rcDistParam.DistFunc = m_afpDistortFunc[DF_HADS + g_aucConvertToBit[ rcDistParam.iCols ] + 1 ]; } // initialize rcDistParam.iSubShift = 0; #if HHI_INTERVIEW_SKIP rcDistParam.pUsed = 0; rcDistParam.iStrideUsed = 0; #endif } Void #if NS_HAD TComRdCost::setDistParam( DistParam& rcDP, Pel* p1, Int iStride1, Pel* p2, Int iStride2, Int iWidth, Int iHeight, Bool bHadamard, Bool bUseNSHAD ) #else TComRdCost::setDistParam( DistParam& rcDP, Pel* p1, Int iStride1, Pel* p2, Int iStride2, Int iWidth, Int iHeight, Bool bHadamard ) #endif { rcDP.pOrg = p1; rcDP.pCur = p2; rcDP.iStrideOrg = iStride1; rcDP.iStrideCur = iStride2; rcDP.iCols = iWidth; rcDP.iRows = iHeight; rcDP.iStep = 1; rcDP.iSubShift = 0; rcDP.DistFunc = m_afpDistortFunc[ ( bHadamard ? DF_HADS : DF_SADS ) + g_aucConvertToBit[ iWidth ] + 1 ]; #if HHI_INTERVIEW_SKIP rcDP.pUsed = 0; rcDP.iStrideUsed = 0; #endif #if NS_HAD rcDP.bUseNSHAD = bUseNSHAD; #endif } UInt TComRdCost::calcHAD( Pel* pi0, Int iStride0, Pel* pi1, Int iStride1, Int iWidth, Int iHeight ) { UInt uiSum = 0; Int x, y; if ( ( (iWidth % 8) == 0 ) && ( (iHeight % 8) == 0 ) ) { for ( y=0; y> g_uiBitIncrement ); } #if HHI_INTERVIEW_SKIP UInt TComRdCost::getDistPart( Pel* piCur, Int iCurStride, Pel* piOrg, Int iOrgStride, Pel* piUsed, Int iUsedStride, UInt uiBlkWidth, UInt uiBlkHeight, DFunc eDFunc ) { DistParam cDtParam; setDistParam( uiBlkWidth, uiBlkHeight, eDFunc, cDtParam ); cDtParam.pOrg = piOrg; cDtParam.pCur = piCur; cDtParam.pUsed = piUsed; cDtParam.iStrideOrg = iOrgStride; cDtParam.iStrideCur = iCurStride; cDtParam.iStrideUsed= iUsedStride; #ifdef DCM_RDCOST_TEMP_FIX //Temporary fix since DistParam is lacking a constructor and the variable iStep is not initialized cDtParam.iStep = 1; #endif #ifdef WEIGHT_PRED cDtParam.applyWeight = false; cDtParam.uiComp = 255; // just for assert: to be sure it was set before use, since only values 0,1 or 2 are allowed. #endif #if LGE_ILLUCOMP_B0045 cDtParam.bUseIC = false; #endif return cDtParam.DistFunc( &cDtParam ); } #endif #if WEIGHTED_CHROMA_DISTORTION UInt TComRdCost::getDistPart( Pel* piCur, Int iCurStride, Pel* piOrg, Int iOrgStride, UInt uiBlkWidth, UInt uiBlkHeight, Bool bWeighted, DFunc eDFunc ) #else UInt TComRdCost::getDistPart( Pel* piCur, Int iCurStride, Pel* piOrg, Int iOrgStride, UInt uiBlkWidth, UInt uiBlkHeight, DFunc eDFunc ) #endif { DistParam cDtParam; setDistParam( uiBlkWidth, uiBlkHeight, eDFunc, cDtParam ); cDtParam.pOrg = piOrg; cDtParam.pCur = piCur; cDtParam.iStrideOrg = iOrgStride; cDtParam.iStrideCur = iCurStride; cDtParam.iStep = 1; cDtParam.bApplyWeight = false; cDtParam.uiComp = 255; // just for assert: to be sure it was set before use, since only values 0,1 or 2 are allowed. #if WEIGHTED_CHROMA_DISTORTION #if LGE_ILLUCOMP_B0045 cDtParam.bUseIC = false; #endif if (bWeighted) { return ((int) (m_chromaDistortionWeight * cDtParam.DistFunc( &cDtParam ))); } else { return cDtParam.DistFunc( &cDtParam ); } #else return cDtParam.DistFunc( &cDtParam ); #endif } #if SAIT_VSO_EST_A0033 UInt TComRdCost::getDistPart( Pel* piCur, Int iCurStride, Pel* piOrg, Int iOrgStride, Pel* piVirRec, Pel* piVirOrg, Int iVirStride, UInt uiBlkWidth, UInt uiBlkHeight, DFunc eDFunc ) { AOT( ( m_dDisparityCoeff <= 0 ) || ( m_dDisparityCoeff > 10 ) ); DistParam cDtParam; setDistParam( uiBlkWidth, uiBlkHeight, eDFunc, cDtParam ); cDtParam.pOrg = piOrg; cDtParam.pCur = piCur; cDtParam.pVirRec = piVirRec; cDtParam.pVirOrg = piVirOrg; cDtParam.iStrideVir = iVirStride; cDtParam.iStrideOrg = iOrgStride; cDtParam.iStrideCur = iCurStride; cDtParam.iStep = 1; cDtParam.bApplyWeight = false; cDtParam.uiComp = 255; // just for assert: to be sure it was set before use, since only values 0,1 or 2 are allowed. #if LGE_ILLUCOMP_B0045 cDtParam.bUseIC = false; #endif return cDtParam.DistFunc( &cDtParam ); } #endif UInt TComRdCost::xGetSAD( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetSADic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideOrg = pcDtParam->iStrideOrg; UInt uiSum = 0; for( ; iRows != 0; iRows-- ) { for (Int n = 0; n < iCols; n++ ) { uiSum += abs( piOrg[n] - piCur[n] ); } piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum >> g_uiBitIncrement ); } UInt TComRdCost::xGetSAD4( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetSAD4ic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] ); uiSum += abs( piOrg[1] - piCur[1] ); uiSum += abs( piOrg[2] - piCur[2] ); uiSum += abs( piOrg[3] - piCur[3] ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } UInt TComRdCost::xGetSAD8( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetSAD8ic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] ); uiSum += abs( piOrg[1] - piCur[1] ); uiSum += abs( piOrg[2] - piCur[2] ); uiSum += abs( piOrg[3] - piCur[3] ); uiSum += abs( piOrg[4] - piCur[4] ); uiSum += abs( piOrg[5] - piCur[5] ); uiSum += abs( piOrg[6] - piCur[6] ); uiSum += abs( piOrg[7] - piCur[7] ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } UInt TComRdCost::xGetSAD16( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetSAD16ic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] ); uiSum += abs( piOrg[1] - piCur[1] ); uiSum += abs( piOrg[2] - piCur[2] ); uiSum += abs( piOrg[3] - piCur[3] ); uiSum += abs( piOrg[4] - piCur[4] ); uiSum += abs( piOrg[5] - piCur[5] ); uiSum += abs( piOrg[6] - piCur[6] ); uiSum += abs( piOrg[7] - piCur[7] ); uiSum += abs( piOrg[8] - piCur[8] ); uiSum += abs( piOrg[9] - piCur[9] ); uiSum += abs( piOrg[10] - piCur[10] ); uiSum += abs( piOrg[11] - piCur[11] ); uiSum += abs( piOrg[12] - piCur[12] ); uiSum += abs( piOrg[13] - piCur[13] ); uiSum += abs( piOrg[14] - piCur[14] ); uiSum += abs( piOrg[15] - piCur[15] ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #if AMP_SAD UInt TComRdCost::xGetSAD12( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetSAD12ic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] ); uiSum += abs( piOrg[1] - piCur[1] ); uiSum += abs( piOrg[2] - piCur[2] ); uiSum += abs( piOrg[3] - piCur[3] ); uiSum += abs( piOrg[4] - piCur[4] ); uiSum += abs( piOrg[5] - piCur[5] ); uiSum += abs( piOrg[6] - piCur[6] ); uiSum += abs( piOrg[7] - piCur[7] ); uiSum += abs( piOrg[8] - piCur[8] ); uiSum += abs( piOrg[9] - piCur[9] ); uiSum += abs( piOrg[10] - piCur[10] ); uiSum += abs( piOrg[11] - piCur[11] ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #endif UInt TComRdCost::xGetSAD16N( DistParam* pcDtParam ) { #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetSAD16Nic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; for( ; iRows != 0; iRows-=iSubStep ) { for (Int n = 0; n < iCols; n+=16 ) { uiSum += abs( piOrg[n+ 0] - piCur[n+ 0] ); uiSum += abs( piOrg[n+ 1] - piCur[n+ 1] ); uiSum += abs( piOrg[n+ 2] - piCur[n+ 2] ); uiSum += abs( piOrg[n+ 3] - piCur[n+ 3] ); uiSum += abs( piOrg[n+ 4] - piCur[n+ 4] ); uiSum += abs( piOrg[n+ 5] - piCur[n+ 5] ); uiSum += abs( piOrg[n+ 6] - piCur[n+ 6] ); uiSum += abs( piOrg[n+ 7] - piCur[n+ 7] ); uiSum += abs( piOrg[n+ 8] - piCur[n+ 8] ); uiSum += abs( piOrg[n+ 9] - piCur[n+ 9] ); uiSum += abs( piOrg[n+10] - piCur[n+10] ); uiSum += abs( piOrg[n+11] - piCur[n+11] ); uiSum += abs( piOrg[n+12] - piCur[n+12] ); uiSum += abs( piOrg[n+13] - piCur[n+13] ); uiSum += abs( piOrg[n+14] - piCur[n+14] ); uiSum += abs( piOrg[n+15] - piCur[n+15] ); } piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } UInt TComRdCost::xGetSAD32( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetSAD32ic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] ); uiSum += abs( piOrg[1] - piCur[1] ); uiSum += abs( piOrg[2] - piCur[2] ); uiSum += abs( piOrg[3] - piCur[3] ); uiSum += abs( piOrg[4] - piCur[4] ); uiSum += abs( piOrg[5] - piCur[5] ); uiSum += abs( piOrg[6] - piCur[6] ); uiSum += abs( piOrg[7] - piCur[7] ); uiSum += abs( piOrg[8] - piCur[8] ); uiSum += abs( piOrg[9] - piCur[9] ); uiSum += abs( piOrg[10] - piCur[10] ); uiSum += abs( piOrg[11] - piCur[11] ); uiSum += abs( piOrg[12] - piCur[12] ); uiSum += abs( piOrg[13] - piCur[13] ); uiSum += abs( piOrg[14] - piCur[14] ); uiSum += abs( piOrg[15] - piCur[15] ); uiSum += abs( piOrg[16] - piCur[16] ); uiSum += abs( piOrg[17] - piCur[17] ); uiSum += abs( piOrg[18] - piCur[18] ); uiSum += abs( piOrg[19] - piCur[19] ); uiSum += abs( piOrg[20] - piCur[20] ); uiSum += abs( piOrg[21] - piCur[21] ); uiSum += abs( piOrg[22] - piCur[22] ); uiSum += abs( piOrg[23] - piCur[23] ); uiSum += abs( piOrg[24] - piCur[24] ); uiSum += abs( piOrg[25] - piCur[25] ); uiSum += abs( piOrg[26] - piCur[26] ); uiSum += abs( piOrg[27] - piCur[27] ); uiSum += abs( piOrg[28] - piCur[28] ); uiSum += abs( piOrg[29] - piCur[29] ); uiSum += abs( piOrg[30] - piCur[30] ); uiSum += abs( piOrg[31] - piCur[31] ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #if AMP_SAD UInt TComRdCost::xGetSAD24( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetSAD24ic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] ); uiSum += abs( piOrg[1] - piCur[1] ); uiSum += abs( piOrg[2] - piCur[2] ); uiSum += abs( piOrg[3] - piCur[3] ); uiSum += abs( piOrg[4] - piCur[4] ); uiSum += abs( piOrg[5] - piCur[5] ); uiSum += abs( piOrg[6] - piCur[6] ); uiSum += abs( piOrg[7] - piCur[7] ); uiSum += abs( piOrg[8] - piCur[8] ); uiSum += abs( piOrg[9] - piCur[9] ); uiSum += abs( piOrg[10] - piCur[10] ); uiSum += abs( piOrg[11] - piCur[11] ); uiSum += abs( piOrg[12] - piCur[12] ); uiSum += abs( piOrg[13] - piCur[13] ); uiSum += abs( piOrg[14] - piCur[14] ); uiSum += abs( piOrg[15] - piCur[15] ); uiSum += abs( piOrg[16] - piCur[16] ); uiSum += abs( piOrg[17] - piCur[17] ); uiSum += abs( piOrg[18] - piCur[18] ); uiSum += abs( piOrg[19] - piCur[19] ); uiSum += abs( piOrg[20] - piCur[20] ); uiSum += abs( piOrg[21] - piCur[21] ); uiSum += abs( piOrg[22] - piCur[22] ); uiSum += abs( piOrg[23] - piCur[23] ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #endif UInt TComRdCost::xGetSAD64( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetSAD64ic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] ); uiSum += abs( piOrg[1] - piCur[1] ); uiSum += abs( piOrg[2] - piCur[2] ); uiSum += abs( piOrg[3] - piCur[3] ); uiSum += abs( piOrg[4] - piCur[4] ); uiSum += abs( piOrg[5] - piCur[5] ); uiSum += abs( piOrg[6] - piCur[6] ); uiSum += abs( piOrg[7] - piCur[7] ); uiSum += abs( piOrg[8] - piCur[8] ); uiSum += abs( piOrg[9] - piCur[9] ); uiSum += abs( piOrg[10] - piCur[10] ); uiSum += abs( piOrg[11] - piCur[11] ); uiSum += abs( piOrg[12] - piCur[12] ); uiSum += abs( piOrg[13] - piCur[13] ); uiSum += abs( piOrg[14] - piCur[14] ); uiSum += abs( piOrg[15] - piCur[15] ); uiSum += abs( piOrg[16] - piCur[16] ); uiSum += abs( piOrg[17] - piCur[17] ); uiSum += abs( piOrg[18] - piCur[18] ); uiSum += abs( piOrg[19] - piCur[19] ); uiSum += abs( piOrg[20] - piCur[20] ); uiSum += abs( piOrg[21] - piCur[21] ); uiSum += abs( piOrg[22] - piCur[22] ); uiSum += abs( piOrg[23] - piCur[23] ); uiSum += abs( piOrg[24] - piCur[24] ); uiSum += abs( piOrg[25] - piCur[25] ); uiSum += abs( piOrg[26] - piCur[26] ); uiSum += abs( piOrg[27] - piCur[27] ); uiSum += abs( piOrg[28] - piCur[28] ); uiSum += abs( piOrg[29] - piCur[29] ); uiSum += abs( piOrg[30] - piCur[30] ); uiSum += abs( piOrg[31] - piCur[31] ); uiSum += abs( piOrg[32] - piCur[32] ); uiSum += abs( piOrg[33] - piCur[33] ); uiSum += abs( piOrg[34] - piCur[34] ); uiSum += abs( piOrg[35] - piCur[35] ); uiSum += abs( piOrg[36] - piCur[36] ); uiSum += abs( piOrg[37] - piCur[37] ); uiSum += abs( piOrg[38] - piCur[38] ); uiSum += abs( piOrg[39] - piCur[39] ); uiSum += abs( piOrg[40] - piCur[40] ); uiSum += abs( piOrg[41] - piCur[41] ); uiSum += abs( piOrg[42] - piCur[42] ); uiSum += abs( piOrg[43] - piCur[43] ); uiSum += abs( piOrg[44] - piCur[44] ); uiSum += abs( piOrg[45] - piCur[45] ); uiSum += abs( piOrg[46] - piCur[46] ); uiSum += abs( piOrg[47] - piCur[47] ); uiSum += abs( piOrg[48] - piCur[48] ); uiSum += abs( piOrg[49] - piCur[49] ); uiSum += abs( piOrg[50] - piCur[50] ); uiSum += abs( piOrg[51] - piCur[51] ); uiSum += abs( piOrg[52] - piCur[52] ); uiSum += abs( piOrg[53] - piCur[53] ); uiSum += abs( piOrg[54] - piCur[54] ); uiSum += abs( piOrg[55] - piCur[55] ); uiSum += abs( piOrg[56] - piCur[56] ); uiSum += abs( piOrg[57] - piCur[57] ); uiSum += abs( piOrg[58] - piCur[58] ); uiSum += abs( piOrg[59] - piCur[59] ); uiSum += abs( piOrg[60] - piCur[60] ); uiSum += abs( piOrg[61] - piCur[61] ); uiSum += abs( piOrg[62] - piCur[62] ); uiSum += abs( piOrg[63] - piCur[63] ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #if AMP_SAD UInt TComRdCost::xGetSAD48( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetSAD48ic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] ); uiSum += abs( piOrg[1] - piCur[1] ); uiSum += abs( piOrg[2] - piCur[2] ); uiSum += abs( piOrg[3] - piCur[3] ); uiSum += abs( piOrg[4] - piCur[4] ); uiSum += abs( piOrg[5] - piCur[5] ); uiSum += abs( piOrg[6] - piCur[6] ); uiSum += abs( piOrg[7] - piCur[7] ); uiSum += abs( piOrg[8] - piCur[8] ); uiSum += abs( piOrg[9] - piCur[9] ); uiSum += abs( piOrg[10] - piCur[10] ); uiSum += abs( piOrg[11] - piCur[11] ); uiSum += abs( piOrg[12] - piCur[12] ); uiSum += abs( piOrg[13] - piCur[13] ); uiSum += abs( piOrg[14] - piCur[14] ); uiSum += abs( piOrg[15] - piCur[15] ); uiSum += abs( piOrg[16] - piCur[16] ); uiSum += abs( piOrg[17] - piCur[17] ); uiSum += abs( piOrg[18] - piCur[18] ); uiSum += abs( piOrg[19] - piCur[19] ); uiSum += abs( piOrg[20] - piCur[20] ); uiSum += abs( piOrg[21] - piCur[21] ); uiSum += abs( piOrg[22] - piCur[22] ); uiSum += abs( piOrg[23] - piCur[23] ); uiSum += abs( piOrg[24] - piCur[24] ); uiSum += abs( piOrg[25] - piCur[25] ); uiSum += abs( piOrg[26] - piCur[26] ); uiSum += abs( piOrg[27] - piCur[27] ); uiSum += abs( piOrg[28] - piCur[28] ); uiSum += abs( piOrg[29] - piCur[29] ); uiSum += abs( piOrg[30] - piCur[30] ); uiSum += abs( piOrg[31] - piCur[31] ); uiSum += abs( piOrg[32] - piCur[32] ); uiSum += abs( piOrg[33] - piCur[33] ); uiSum += abs( piOrg[34] - piCur[34] ); uiSum += abs( piOrg[35] - piCur[35] ); uiSum += abs( piOrg[36] - piCur[36] ); uiSum += abs( piOrg[37] - piCur[37] ); uiSum += abs( piOrg[38] - piCur[38] ); uiSum += abs( piOrg[39] - piCur[39] ); uiSum += abs( piOrg[40] - piCur[40] ); uiSum += abs( piOrg[41] - piCur[41] ); uiSum += abs( piOrg[42] - piCur[42] ); uiSum += abs( piOrg[43] - piCur[43] ); uiSum += abs( piOrg[44] - piCur[44] ); uiSum += abs( piOrg[45] - piCur[45] ); uiSum += abs( piOrg[46] - piCur[46] ); uiSum += abs( piOrg[47] - piCur[47] ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #endif // ==================================================================================================================== // Distortion functions // ==================================================================================================================== // -------------------------------------------------------------------------------------------------------------------- // SAD // -------------------------------------------------------------------------------------------------------------------- #if LGE_ILLUCOMP_B0045 UInt TComRdCost::xGetSADic( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideOrg = pcDtParam->iStrideOrg; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0; Int iDeltaC; for( ; iRows != 0; iRows-- ) { for (Int n = 0; n < iCols; n++ ) { iOrigAvg += piOrg[n]; iCurAvg += piCur[n]; } piOrg += iStrideOrg; piCur += iStrideCur; } piOrg = pcDtParam->pOrg; piCur = pcDtParam->pCur; iRows = pcDtParam->iRows; iDeltaC = (iOrigAvg - iCurAvg)/iCols/iRows; for( ; iRows != 0; iRows-- ) { for (Int n = 0; n < iCols; n++ ) { uiSum += abs( piOrg[n] - piCur[n] - iDeltaC ); } piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum >> g_uiBitIncrement ); } UInt TComRdCost::xGetSAD4ic( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0, uiRowCnt = 0; Int iDeltaC; for( ; iRows != 0; iRows-=iSubStep ) { iOrigAvg += piOrg[0]; iOrigAvg += piOrg[1]; iOrigAvg += piOrg[2]; iOrigAvg += piOrg[3]; iCurAvg += piCur[0]; iCurAvg += piCur[1]; iCurAvg += piCur[2]; iCurAvg += piCur[3]; piOrg += iStrideOrg; piCur += iStrideCur; uiRowCnt++; } piOrg = pcDtParam->pOrg; piCur = pcDtParam->pCur; iRows = pcDtParam->iRows; iDeltaC = uiRowCnt ? ((iOrigAvg - iCurAvg)/uiRowCnt/4) : 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] - iDeltaC ); uiSum += abs( piOrg[1] - piCur[1] - iDeltaC ); uiSum += abs( piOrg[2] - piCur[2] - iDeltaC ); uiSum += abs( piOrg[3] - piCur[3] - iDeltaC ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } UInt TComRdCost::xGetSAD8ic( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0, uiRowCnt = 0; Int iDeltaC; for( ; iRows != 0; iRows-=iSubStep ) { iOrigAvg += piOrg[0]; iOrigAvg += piOrg[1]; iOrigAvg += piOrg[2]; iOrigAvg += piOrg[3]; iOrigAvg += piOrg[4]; iOrigAvg += piOrg[5]; iOrigAvg += piOrg[6]; iOrigAvg += piOrg[7]; iCurAvg += piCur[0]; iCurAvg += piCur[1]; iCurAvg += piCur[2]; iCurAvg += piCur[3]; iCurAvg += piCur[4]; iCurAvg += piCur[5]; iCurAvg += piCur[6]; iCurAvg += piCur[7]; piOrg += iStrideOrg; piCur += iStrideCur; uiRowCnt++; } piOrg = pcDtParam->pOrg; piCur = pcDtParam->pCur; iRows = pcDtParam->iRows; iDeltaC = uiRowCnt ? ((iOrigAvg - iCurAvg)/uiRowCnt/8) : 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] - iDeltaC ); uiSum += abs( piOrg[1] - piCur[1] - iDeltaC ); uiSum += abs( piOrg[2] - piCur[2] - iDeltaC ); uiSum += abs( piOrg[3] - piCur[3] - iDeltaC ); uiSum += abs( piOrg[4] - piCur[4] - iDeltaC ); uiSum += abs( piOrg[5] - piCur[5] - iDeltaC ); uiSum += abs( piOrg[6] - piCur[6] - iDeltaC ); uiSum += abs( piOrg[7] - piCur[7] - iDeltaC ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } UInt TComRdCost::xGetSAD16ic( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0, uiRowCnt = 0; Int iDeltaC; for( ; iRows != 0; iRows-=iSubStep ) { iOrigAvg += piOrg[0]; iOrigAvg += piOrg[1]; iOrigAvg += piOrg[2]; iOrigAvg += piOrg[3]; iOrigAvg += piOrg[4]; iOrigAvg += piOrg[5]; iOrigAvg += piOrg[6]; iOrigAvg += piOrg[7]; iOrigAvg += piOrg[8]; iOrigAvg += piOrg[9]; iOrigAvg += piOrg[10]; iOrigAvg += piOrg[11]; iOrigAvg += piOrg[12]; iOrigAvg += piOrg[13]; iOrigAvg += piOrg[14]; iOrigAvg += piOrg[15]; iCurAvg += piCur[0]; iCurAvg += piCur[1]; iCurAvg += piCur[2]; iCurAvg += piCur[3]; iCurAvg += piCur[4]; iCurAvg += piCur[5]; iCurAvg += piCur[6]; iCurAvg += piCur[7]; iCurAvg += piCur[8]; iCurAvg += piCur[9]; iCurAvg += piCur[10]; iCurAvg += piCur[11]; iCurAvg += piCur[12]; iCurAvg += piCur[13]; iCurAvg += piCur[14]; iCurAvg += piCur[15]; piOrg += iStrideOrg; piCur += iStrideCur; uiRowCnt++; } piOrg = pcDtParam->pOrg; piCur = pcDtParam->pCur; iRows = pcDtParam->iRows; iDeltaC = uiRowCnt ? ((iOrigAvg - iCurAvg)/uiRowCnt/16) : 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] - iDeltaC ); uiSum += abs( piOrg[1] - piCur[1] - iDeltaC ); uiSum += abs( piOrg[2] - piCur[2] - iDeltaC ); uiSum += abs( piOrg[3] - piCur[3] - iDeltaC ); uiSum += abs( piOrg[4] - piCur[4] - iDeltaC ); uiSum += abs( piOrg[5] - piCur[5] - iDeltaC ); uiSum += abs( piOrg[6] - piCur[6] - iDeltaC ); uiSum += abs( piOrg[7] - piCur[7] - iDeltaC ); uiSum += abs( piOrg[8] - piCur[8] - iDeltaC ); uiSum += abs( piOrg[9] - piCur[9] - iDeltaC ); uiSum += abs( piOrg[10] - piCur[10] - iDeltaC ); uiSum += abs( piOrg[11] - piCur[11] - iDeltaC ); uiSum += abs( piOrg[12] - piCur[12] - iDeltaC ); uiSum += abs( piOrg[13] - piCur[13] - iDeltaC ); uiSum += abs( piOrg[14] - piCur[14] - iDeltaC ); uiSum += abs( piOrg[15] - piCur[15] - iDeltaC ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #if AMP_SAD UInt TComRdCost::xGetSAD12ic( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0, uiRowCnt = 0; Int iDeltaC; for( ; iRows != 0; iRows-=iSubStep ) { iOrigAvg += piOrg[0]; iOrigAvg += piOrg[1]; iOrigAvg += piOrg[2]; iOrigAvg += piOrg[3]; iOrigAvg += piOrg[4]; iOrigAvg += piOrg[5]; iOrigAvg += piOrg[6]; iOrigAvg += piOrg[7]; iOrigAvg += piOrg[8]; iOrigAvg += piOrg[9]; iOrigAvg += piOrg[10]; iOrigAvg += piOrg[11]; iCurAvg += piCur[0]; iCurAvg += piCur[1]; iCurAvg += piCur[2]; iCurAvg += piCur[3]; iCurAvg += piCur[4]; iCurAvg += piCur[5]; iCurAvg += piCur[6]; iCurAvg += piCur[7]; iCurAvg += piCur[8]; iCurAvg += piCur[9]; iCurAvg += piCur[10]; iCurAvg += piCur[11]; piOrg += iStrideOrg; piCur += iStrideCur; uiRowCnt++; } piOrg = pcDtParam->pOrg; piCur = pcDtParam->pCur; iRows = pcDtParam->iRows; iDeltaC = uiRowCnt ? ((iOrigAvg - iCurAvg)/uiRowCnt/12) : 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] - iDeltaC ); uiSum += abs( piOrg[1] - piCur[1] - iDeltaC ); uiSum += abs( piOrg[2] - piCur[2] - iDeltaC ); uiSum += abs( piOrg[3] - piCur[3] - iDeltaC ); uiSum += abs( piOrg[4] - piCur[4] - iDeltaC ); uiSum += abs( piOrg[5] - piCur[5] - iDeltaC ); uiSum += abs( piOrg[6] - piCur[6] - iDeltaC ); uiSum += abs( piOrg[7] - piCur[7] - iDeltaC ); uiSum += abs( piOrg[8] - piCur[8] - iDeltaC ); uiSum += abs( piOrg[9] - piCur[9] - iDeltaC ); uiSum += abs( piOrg[10] - piCur[10] - iDeltaC ); uiSum += abs( piOrg[11] - piCur[11] - iDeltaC ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #endif UInt TComRdCost::xGetSAD16Nic( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0, uiRowCnt = 0, uiColCnt = (iCols-1)/16 + 1; Int iDeltaC; for( ; iRows != 0; iRows-=iSubStep ) { for (Int n = 0; n < iCols; n+=16 ) { iOrigAvg += piOrg[n + 0]; iOrigAvg += piOrg[n + 1]; iOrigAvg += piOrg[n + 2]; iOrigAvg += piOrg[n + 3]; iOrigAvg += piOrg[n + 4]; iOrigAvg += piOrg[n + 5]; iOrigAvg += piOrg[n + 6]; iOrigAvg += piOrg[n + 7]; iOrigAvg += piOrg[n + 8]; iOrigAvg += piOrg[n + 9]; iOrigAvg += piOrg[n + 10]; iOrigAvg += piOrg[n + 11]; iOrigAvg += piOrg[n + 12]; iOrigAvg += piOrg[n + 13]; iOrigAvg += piOrg[n + 14]; iOrigAvg += piOrg[n + 15]; iCurAvg += piCur[n + 0]; iCurAvg += piCur[n + 1]; iCurAvg += piCur[n + 2]; iCurAvg += piCur[n + 3]; iCurAvg += piCur[n + 4]; iCurAvg += piCur[n + 5]; iCurAvg += piCur[n + 6]; iCurAvg += piCur[n + 7]; iCurAvg += piCur[n + 8]; iCurAvg += piCur[n + 9]; iCurAvg += piCur[n + 10]; iCurAvg += piCur[n + 11]; iCurAvg += piCur[n + 12]; iCurAvg += piCur[n + 13]; iCurAvg += piCur[n + 14]; iCurAvg += piCur[n + 15]; } piOrg += iStrideOrg; piCur += iStrideCur; uiRowCnt++; } piOrg = pcDtParam->pOrg; piCur = pcDtParam->pCur; iRows = pcDtParam->iRows; iDeltaC = (uiRowCnt && uiColCnt) ? ((iOrigAvg - iCurAvg)/uiRowCnt/uiColCnt/16) : 0; for( ; iRows != 0; iRows-=iSubStep ) { for (Int n = 0; n < iCols; n+=16 ) { uiSum += abs( piOrg[n+ 0] - piCur[n+ 0] - iDeltaC ); uiSum += abs( piOrg[n+ 1] - piCur[n+ 1] - iDeltaC ); uiSum += abs( piOrg[n+ 2] - piCur[n+ 2] - iDeltaC ); uiSum += abs( piOrg[n+ 3] - piCur[n+ 3] - iDeltaC ); uiSum += abs( piOrg[n+ 4] - piCur[n+ 4] - iDeltaC ); uiSum += abs( piOrg[n+ 5] - piCur[n+ 5] - iDeltaC ); uiSum += abs( piOrg[n+ 6] - piCur[n+ 6] - iDeltaC ); uiSum += abs( piOrg[n+ 7] - piCur[n+ 7] - iDeltaC ); uiSum += abs( piOrg[n+ 8] - piCur[n+ 8] - iDeltaC ); uiSum += abs( piOrg[n+ 9] - piCur[n+ 9] - iDeltaC ); uiSum += abs( piOrg[n+10] - piCur[n+10] - iDeltaC ); uiSum += abs( piOrg[n+11] - piCur[n+11] - iDeltaC ); uiSum += abs( piOrg[n+12] - piCur[n+12] - iDeltaC ); uiSum += abs( piOrg[n+13] - piCur[n+13] - iDeltaC ); uiSum += abs( piOrg[n+14] - piCur[n+14] - iDeltaC ); uiSum += abs( piOrg[n+15] - piCur[n+15] - iDeltaC ); } piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } UInt TComRdCost::xGetSAD32ic( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0, uiRowCnt = 0; Int iDeltaC; for( ; iRows != 0; iRows-=iSubStep ) { iOrigAvg += piOrg[0]; iOrigAvg += piOrg[1]; iOrigAvg += piOrg[2]; iOrigAvg += piOrg[3]; iOrigAvg += piOrg[4]; iOrigAvg += piOrg[5]; iOrigAvg += piOrg[6]; iOrigAvg += piOrg[7]; iOrigAvg += piOrg[8]; iOrigAvg += piOrg[9]; iOrigAvg += piOrg[10]; iOrigAvg += piOrg[11]; iOrigAvg += piOrg[12]; iOrigAvg += piOrg[13]; iOrigAvg += piOrg[14]; iOrigAvg += piOrg[15]; iOrigAvg += piOrg[16]; iOrigAvg += piOrg[17]; iOrigAvg += piOrg[18]; iOrigAvg += piOrg[19]; iOrigAvg += piOrg[20]; iOrigAvg += piOrg[21]; iOrigAvg += piOrg[22]; iOrigAvg += piOrg[23]; iOrigAvg += piOrg[24]; iOrigAvg += piOrg[25]; iOrigAvg += piOrg[26]; iOrigAvg += piOrg[27]; iOrigAvg += piOrg[28]; iOrigAvg += piOrg[29]; iOrigAvg += piOrg[30]; iOrigAvg += piOrg[31]; iCurAvg += piCur[0]; iCurAvg += piCur[1]; iCurAvg += piCur[2]; iCurAvg += piCur[3]; iCurAvg += piCur[4]; iCurAvg += piCur[5]; iCurAvg += piCur[6]; iCurAvg += piCur[7]; iCurAvg += piCur[8]; iCurAvg += piCur[9]; iCurAvg += piCur[10]; iCurAvg += piCur[11]; iCurAvg += piCur[12]; iCurAvg += piCur[13]; iCurAvg += piCur[14]; iCurAvg += piCur[15]; iCurAvg += piCur[16]; iCurAvg += piCur[17]; iCurAvg += piCur[18]; iCurAvg += piCur[19]; iCurAvg += piCur[20]; iCurAvg += piCur[21]; iCurAvg += piCur[22]; iCurAvg += piCur[23]; iCurAvg += piCur[24]; iCurAvg += piCur[25]; iCurAvg += piCur[26]; iCurAvg += piCur[27]; iCurAvg += piCur[28]; iCurAvg += piCur[29]; iCurAvg += piCur[30]; iCurAvg += piCur[31]; piOrg += iStrideOrg; piCur += iStrideCur; uiRowCnt++; } piOrg = pcDtParam->pOrg; piCur = pcDtParam->pCur; iRows = pcDtParam->iRows; iDeltaC = uiRowCnt ? ((iOrigAvg - iCurAvg)/uiRowCnt/32) : 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] - iDeltaC ); uiSum += abs( piOrg[1] - piCur[1] - iDeltaC ); uiSum += abs( piOrg[2] - piCur[2] - iDeltaC ); uiSum += abs( piOrg[3] - piCur[3] - iDeltaC ); uiSum += abs( piOrg[4] - piCur[4] - iDeltaC ); uiSum += abs( piOrg[5] - piCur[5] - iDeltaC ); uiSum += abs( piOrg[6] - piCur[6] - iDeltaC ); uiSum += abs( piOrg[7] - piCur[7] - iDeltaC ); uiSum += abs( piOrg[8] - piCur[8] - iDeltaC ); uiSum += abs( piOrg[9] - piCur[9] - iDeltaC ); uiSum += abs( piOrg[10] - piCur[10] - iDeltaC ); uiSum += abs( piOrg[11] - piCur[11] - iDeltaC ); uiSum += abs( piOrg[12] - piCur[12] - iDeltaC ); uiSum += abs( piOrg[13] - piCur[13] - iDeltaC ); uiSum += abs( piOrg[14] - piCur[14] - iDeltaC ); uiSum += abs( piOrg[15] - piCur[15] - iDeltaC ); uiSum += abs( piOrg[16] - piCur[16] - iDeltaC ); uiSum += abs( piOrg[17] - piCur[17] - iDeltaC ); uiSum += abs( piOrg[18] - piCur[18] - iDeltaC ); uiSum += abs( piOrg[19] - piCur[19] - iDeltaC ); uiSum += abs( piOrg[20] - piCur[20] - iDeltaC ); uiSum += abs( piOrg[21] - piCur[21] - iDeltaC ); uiSum += abs( piOrg[22] - piCur[22] - iDeltaC ); uiSum += abs( piOrg[23] - piCur[23] - iDeltaC ); uiSum += abs( piOrg[24] - piCur[24] - iDeltaC ); uiSum += abs( piOrg[25] - piCur[25] - iDeltaC ); uiSum += abs( piOrg[26] - piCur[26] - iDeltaC ); uiSum += abs( piOrg[27] - piCur[27] - iDeltaC ); uiSum += abs( piOrg[28] - piCur[28] - iDeltaC ); uiSum += abs( piOrg[29] - piCur[29] - iDeltaC ); uiSum += abs( piOrg[30] - piCur[30] - iDeltaC ); uiSum += abs( piOrg[31] - piCur[31] - iDeltaC ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #if AMP_SAD UInt TComRdCost::xGetSAD24ic( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0, uiRowCnt = 0; Int iDeltaC; for( ; iRows != 0; iRows-=iSubStep ) { iOrigAvg += piOrg[0]; iOrigAvg += piOrg[1]; iOrigAvg += piOrg[2]; iOrigAvg += piOrg[3]; iOrigAvg += piOrg[4]; iOrigAvg += piOrg[5]; iOrigAvg += piOrg[6]; iOrigAvg += piOrg[7]; iOrigAvg += piOrg[8]; iOrigAvg += piOrg[9]; iOrigAvg += piOrg[10]; iOrigAvg += piOrg[11]; iOrigAvg += piOrg[12]; iOrigAvg += piOrg[13]; iOrigAvg += piOrg[14]; iOrigAvg += piOrg[15]; iOrigAvg += piOrg[16]; iOrigAvg += piOrg[17]; iOrigAvg += piOrg[18]; iOrigAvg += piOrg[19]; iOrigAvg += piOrg[20]; iOrigAvg += piOrg[21]; iOrigAvg += piOrg[22]; iOrigAvg += piOrg[23]; iCurAvg += piCur[0]; iCurAvg += piCur[1]; iCurAvg += piCur[2]; iCurAvg += piCur[3]; iCurAvg += piCur[4]; iCurAvg += piCur[5]; iCurAvg += piCur[6]; iCurAvg += piCur[7]; iCurAvg += piCur[8]; iCurAvg += piCur[9]; iCurAvg += piCur[10]; iCurAvg += piCur[11]; iCurAvg += piCur[12]; iCurAvg += piCur[13]; iCurAvg += piCur[14]; iCurAvg += piCur[15]; iCurAvg += piCur[16]; iCurAvg += piCur[17]; iCurAvg += piCur[18]; iCurAvg += piCur[19]; iCurAvg += piCur[20]; iCurAvg += piCur[21]; iCurAvg += piCur[22]; iCurAvg += piCur[23]; piOrg += iStrideOrg; piCur += iStrideCur; uiRowCnt++; } piOrg = pcDtParam->pOrg; piCur = pcDtParam->pCur; iRows = pcDtParam->iRows; iDeltaC = uiRowCnt ? ((iOrigAvg - iCurAvg)/uiRowCnt/24) : 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] - iDeltaC ); uiSum += abs( piOrg[1] - piCur[1] - iDeltaC ); uiSum += abs( piOrg[2] - piCur[2] - iDeltaC ); uiSum += abs( piOrg[3] - piCur[3] - iDeltaC ); uiSum += abs( piOrg[4] - piCur[4] - iDeltaC ); uiSum += abs( piOrg[5] - piCur[5] - iDeltaC ); uiSum += abs( piOrg[6] - piCur[6] - iDeltaC ); uiSum += abs( piOrg[7] - piCur[7] - iDeltaC ); uiSum += abs( piOrg[8] - piCur[8] - iDeltaC ); uiSum += abs( piOrg[9] - piCur[9] - iDeltaC ); uiSum += abs( piOrg[10] - piCur[10] - iDeltaC ); uiSum += abs( piOrg[11] - piCur[11] - iDeltaC ); uiSum += abs( piOrg[12] - piCur[12] - iDeltaC ); uiSum += abs( piOrg[13] - piCur[13] - iDeltaC ); uiSum += abs( piOrg[14] - piCur[14] - iDeltaC ); uiSum += abs( piOrg[15] - piCur[15] - iDeltaC ); uiSum += abs( piOrg[16] - piCur[16] - iDeltaC ); uiSum += abs( piOrg[17] - piCur[17] - iDeltaC ); uiSum += abs( piOrg[18] - piCur[18] - iDeltaC ); uiSum += abs( piOrg[19] - piCur[19] - iDeltaC ); uiSum += abs( piOrg[20] - piCur[20] - iDeltaC ); uiSum += abs( piOrg[21] - piCur[21] - iDeltaC ); uiSum += abs( piOrg[22] - piCur[22] - iDeltaC ); uiSum += abs( piOrg[23] - piCur[23] - iDeltaC ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #endif UInt TComRdCost::xGetSAD64ic( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0, uiRowCnt = 0; Int iDeltaC; for( ; iRows != 0; iRows-=iSubStep ) { iOrigAvg += piOrg[0] ; iOrigAvg += piOrg[1] ; iOrigAvg += piOrg[2] ; iOrigAvg += piOrg[3] ; iOrigAvg += piOrg[4] ; iOrigAvg += piOrg[5] ; iOrigAvg += piOrg[6] ; iOrigAvg += piOrg[7] ; iOrigAvg += piOrg[8] ; iOrigAvg += piOrg[9] ; iOrigAvg += piOrg[10] ; iOrigAvg += piOrg[11] ; iOrigAvg += piOrg[12] ; iOrigAvg += piOrg[13] ; iOrigAvg += piOrg[14] ; iOrigAvg += piOrg[15] ; iOrigAvg += piOrg[16] ; iOrigAvg += piOrg[17] ; iOrigAvg += piOrg[18] ; iOrigAvg += piOrg[19] ; iOrigAvg += piOrg[20] ; iOrigAvg += piOrg[21] ; iOrigAvg += piOrg[22] ; iOrigAvg += piOrg[23] ; iOrigAvg += piOrg[24] ; iOrigAvg += piOrg[25] ; iOrigAvg += piOrg[26] ; iOrigAvg += piOrg[27] ; iOrigAvg += piOrg[28] ; iOrigAvg += piOrg[29] ; iOrigAvg += piOrg[30] ; iOrigAvg += piOrg[31] ; iOrigAvg += piOrg[32] ; iOrigAvg += piOrg[33] ; iOrigAvg += piOrg[34] ; iOrigAvg += piOrg[35] ; iOrigAvg += piOrg[36] ; iOrigAvg += piOrg[37] ; iOrigAvg += piOrg[38] ; iOrigAvg += piOrg[39] ; iOrigAvg += piOrg[40] ; iOrigAvg += piOrg[41] ; iOrigAvg += piOrg[42] ; iOrigAvg += piOrg[43] ; iOrigAvg += piOrg[44] ; iOrigAvg += piOrg[45] ; iOrigAvg += piOrg[46] ; iOrigAvg += piOrg[47] ; iOrigAvg += piOrg[48] ; iOrigAvg += piOrg[49] ; iOrigAvg += piOrg[50] ; iOrigAvg += piOrg[51] ; iOrigAvg += piOrg[52] ; iOrigAvg += piOrg[53] ; iOrigAvg += piOrg[54] ; iOrigAvg += piOrg[55] ; iOrigAvg += piOrg[56] ; iOrigAvg += piOrg[57] ; iOrigAvg += piOrg[58] ; iOrigAvg += piOrg[59] ; iOrigAvg += piOrg[60] ; iOrigAvg += piOrg[61] ; iOrigAvg += piOrg[62] ; iOrigAvg += piOrg[63] ; iCurAvg += piCur[0] ; iCurAvg += piCur[1] ; iCurAvg += piCur[2] ; iCurAvg += piCur[3] ; iCurAvg += piCur[4] ; iCurAvg += piCur[5] ; iCurAvg += piCur[6] ; iCurAvg += piCur[7] ; iCurAvg += piCur[8] ; iCurAvg += piCur[9] ; iCurAvg += piCur[10] ; iCurAvg += piCur[11] ; iCurAvg += piCur[12] ; iCurAvg += piCur[13] ; iCurAvg += piCur[14] ; iCurAvg += piCur[15] ; iCurAvg += piCur[16] ; iCurAvg += piCur[17] ; iCurAvg += piCur[18] ; iCurAvg += piCur[19] ; iCurAvg += piCur[20] ; iCurAvg += piCur[21] ; iCurAvg += piCur[22] ; iCurAvg += piCur[23] ; iCurAvg += piCur[24] ; iCurAvg += piCur[25] ; iCurAvg += piCur[26] ; iCurAvg += piCur[27] ; iCurAvg += piCur[28] ; iCurAvg += piCur[29] ; iCurAvg += piCur[30] ; iCurAvg += piCur[31] ; iCurAvg += piCur[32] ; iCurAvg += piCur[33] ; iCurAvg += piCur[34] ; iCurAvg += piCur[35] ; iCurAvg += piCur[36] ; iCurAvg += piCur[37] ; iCurAvg += piCur[38] ; iCurAvg += piCur[39] ; iCurAvg += piCur[40] ; iCurAvg += piCur[41] ; iCurAvg += piCur[42] ; iCurAvg += piCur[43] ; iCurAvg += piCur[44] ; iCurAvg += piCur[45] ; iCurAvg += piCur[46] ; iCurAvg += piCur[47] ; iCurAvg += piCur[48] ; iCurAvg += piCur[49] ; iCurAvg += piCur[50] ; iCurAvg += piCur[51] ; iCurAvg += piCur[52] ; iCurAvg += piCur[53] ; iCurAvg += piCur[54] ; iCurAvg += piCur[55] ; iCurAvg += piCur[56] ; iCurAvg += piCur[57] ; iCurAvg += piCur[58] ; iCurAvg += piCur[59] ; iCurAvg += piCur[60] ; iCurAvg += piCur[61] ; iCurAvg += piCur[62] ; iCurAvg += piCur[63] ; piOrg += iStrideOrg; piCur += iStrideCur; uiRowCnt++; } piOrg = pcDtParam->pOrg; piCur = pcDtParam->pCur; iRows = pcDtParam->iRows; iDeltaC = uiRowCnt ? ((iOrigAvg - iCurAvg)/uiRowCnt/64) : 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] - iDeltaC ); uiSum += abs( piOrg[1] - piCur[1] - iDeltaC ); uiSum += abs( piOrg[2] - piCur[2] - iDeltaC ); uiSum += abs( piOrg[3] - piCur[3] - iDeltaC ); uiSum += abs( piOrg[4] - piCur[4] - iDeltaC ); uiSum += abs( piOrg[5] - piCur[5] - iDeltaC ); uiSum += abs( piOrg[6] - piCur[6] - iDeltaC ); uiSum += abs( piOrg[7] - piCur[7] - iDeltaC ); uiSum += abs( piOrg[8] - piCur[8] - iDeltaC ); uiSum += abs( piOrg[9] - piCur[9] - iDeltaC ); uiSum += abs( piOrg[10] - piCur[10] - iDeltaC ); uiSum += abs( piOrg[11] - piCur[11] - iDeltaC ); uiSum += abs( piOrg[12] - piCur[12] - iDeltaC ); uiSum += abs( piOrg[13] - piCur[13] - iDeltaC ); uiSum += abs( piOrg[14] - piCur[14] - iDeltaC ); uiSum += abs( piOrg[15] - piCur[15] - iDeltaC ); uiSum += abs( piOrg[16] - piCur[16] - iDeltaC ); uiSum += abs( piOrg[17] - piCur[17] - iDeltaC ); uiSum += abs( piOrg[18] - piCur[18] - iDeltaC ); uiSum += abs( piOrg[19] - piCur[19] - iDeltaC ); uiSum += abs( piOrg[20] - piCur[20] - iDeltaC ); uiSum += abs( piOrg[21] - piCur[21] - iDeltaC ); uiSum += abs( piOrg[22] - piCur[22] - iDeltaC ); uiSum += abs( piOrg[23] - piCur[23] - iDeltaC ); uiSum += abs( piOrg[24] - piCur[24] - iDeltaC ); uiSum += abs( piOrg[25] - piCur[25] - iDeltaC ); uiSum += abs( piOrg[26] - piCur[26] - iDeltaC ); uiSum += abs( piOrg[27] - piCur[27] - iDeltaC ); uiSum += abs( piOrg[28] - piCur[28] - iDeltaC ); uiSum += abs( piOrg[29] - piCur[29] - iDeltaC ); uiSum += abs( piOrg[30] - piCur[30] - iDeltaC ); uiSum += abs( piOrg[31] - piCur[31] - iDeltaC ); uiSum += abs( piOrg[32] - piCur[32] - iDeltaC ); uiSum += abs( piOrg[33] - piCur[33] - iDeltaC ); uiSum += abs( piOrg[34] - piCur[34] - iDeltaC ); uiSum += abs( piOrg[35] - piCur[35] - iDeltaC ); uiSum += abs( piOrg[36] - piCur[36] - iDeltaC ); uiSum += abs( piOrg[37] - piCur[37] - iDeltaC ); uiSum += abs( piOrg[38] - piCur[38] - iDeltaC ); uiSum += abs( piOrg[39] - piCur[39] - iDeltaC ); uiSum += abs( piOrg[40] - piCur[40] - iDeltaC ); uiSum += abs( piOrg[41] - piCur[41] - iDeltaC ); uiSum += abs( piOrg[42] - piCur[42] - iDeltaC ); uiSum += abs( piOrg[43] - piCur[43] - iDeltaC ); uiSum += abs( piOrg[44] - piCur[44] - iDeltaC ); uiSum += abs( piOrg[45] - piCur[45] - iDeltaC ); uiSum += abs( piOrg[46] - piCur[46] - iDeltaC ); uiSum += abs( piOrg[47] - piCur[47] - iDeltaC ); uiSum += abs( piOrg[48] - piCur[48] - iDeltaC ); uiSum += abs( piOrg[49] - piCur[49] - iDeltaC ); uiSum += abs( piOrg[50] - piCur[50] - iDeltaC ); uiSum += abs( piOrg[51] - piCur[51] - iDeltaC ); uiSum += abs( piOrg[52] - piCur[52] - iDeltaC ); uiSum += abs( piOrg[53] - piCur[53] - iDeltaC ); uiSum += abs( piOrg[54] - piCur[54] - iDeltaC ); uiSum += abs( piOrg[55] - piCur[55] - iDeltaC ); uiSum += abs( piOrg[56] - piCur[56] - iDeltaC ); uiSum += abs( piOrg[57] - piCur[57] - iDeltaC ); uiSum += abs( piOrg[58] - piCur[58] - iDeltaC ); uiSum += abs( piOrg[59] - piCur[59] - iDeltaC ); uiSum += abs( piOrg[60] - piCur[60] - iDeltaC ); uiSum += abs( piOrg[61] - piCur[61] - iDeltaC ); uiSum += abs( piOrg[62] - piCur[62] - iDeltaC ); uiSum += abs( piOrg[63] - piCur[63] - iDeltaC ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #if AMP_SAD UInt TComRdCost::xGetSAD48ic( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSADw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iSubShift = pcDtParam->iSubShift; Int iSubStep = ( 1 << iSubShift ); Int iStrideCur = pcDtParam->iStrideCur*iSubStep; Int iStrideOrg = pcDtParam->iStrideOrg*iSubStep; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0, uiRowCnt = 0; Int iDeltaC; for( ; iRows != 0; iRows-=iSubStep ) { iOrigAvg += piOrg[0] ; iOrigAvg += piOrg[1] ; iOrigAvg += piOrg[2] ; iOrigAvg += piOrg[3] ; iOrigAvg += piOrg[4] ; iOrigAvg += piOrg[5] ; iOrigAvg += piOrg[6] ; iOrigAvg += piOrg[7] ; iOrigAvg += piOrg[8] ; iOrigAvg += piOrg[9] ; iOrigAvg += piOrg[10] ; iOrigAvg += piOrg[11] ; iOrigAvg += piOrg[12] ; iOrigAvg += piOrg[13] ; iOrigAvg += piOrg[14] ; iOrigAvg += piOrg[15] ; iOrigAvg += piOrg[16] ; iOrigAvg += piOrg[17] ; iOrigAvg += piOrg[18] ; iOrigAvg += piOrg[19] ; iOrigAvg += piOrg[20] ; iOrigAvg += piOrg[21] ; iOrigAvg += piOrg[22] ; iOrigAvg += piOrg[23] ; iOrigAvg += piOrg[24] ; iOrigAvg += piOrg[25] ; iOrigAvg += piOrg[26] ; iOrigAvg += piOrg[27] ; iOrigAvg += piOrg[28] ; iOrigAvg += piOrg[29] ; iOrigAvg += piOrg[30] ; iOrigAvg += piOrg[31] ; iOrigAvg += piOrg[32] ; iOrigAvg += piOrg[33] ; iOrigAvg += piOrg[34] ; iOrigAvg += piOrg[35] ; iOrigAvg += piOrg[36] ; iOrigAvg += piOrg[37] ; iOrigAvg += piOrg[38] ; iOrigAvg += piOrg[39] ; iOrigAvg += piOrg[40] ; iOrigAvg += piOrg[41] ; iOrigAvg += piOrg[42] ; iOrigAvg += piOrg[43] ; iOrigAvg += piOrg[44] ; iOrigAvg += piOrg[45] ; iOrigAvg += piOrg[46] ; iOrigAvg += piOrg[47] ; iCurAvg += piCur[0] ; iCurAvg += piCur[1] ; iCurAvg += piCur[2] ; iCurAvg += piCur[3] ; iCurAvg += piCur[4] ; iCurAvg += piCur[5] ; iCurAvg += piCur[6] ; iCurAvg += piCur[7] ; iCurAvg += piCur[8] ; iCurAvg += piCur[9] ; iCurAvg += piCur[10] ; iCurAvg += piCur[11] ; iCurAvg += piCur[12] ; iCurAvg += piCur[13] ; iCurAvg += piCur[14] ; iCurAvg += piCur[15] ; iCurAvg += piCur[16] ; iCurAvg += piCur[17] ; iCurAvg += piCur[18] ; iCurAvg += piCur[19] ; iCurAvg += piCur[20] ; iCurAvg += piCur[21] ; iCurAvg += piCur[22] ; iCurAvg += piCur[23] ; iCurAvg += piCur[24] ; iCurAvg += piCur[25] ; iCurAvg += piCur[26] ; iCurAvg += piCur[27] ; iCurAvg += piCur[28] ; iCurAvg += piCur[29] ; iCurAvg += piCur[30] ; iCurAvg += piCur[31] ; iCurAvg += piCur[32] ; iCurAvg += piCur[33] ; iCurAvg += piCur[34] ; iCurAvg += piCur[35] ; iCurAvg += piCur[36] ; iCurAvg += piCur[37] ; iCurAvg += piCur[38] ; iCurAvg += piCur[39] ; iCurAvg += piCur[40] ; iCurAvg += piCur[41] ; iCurAvg += piCur[42] ; iCurAvg += piCur[43] ; iCurAvg += piCur[44] ; iCurAvg += piCur[45] ; iCurAvg += piCur[46] ; iCurAvg += piCur[47] ; piOrg += iStrideOrg; piCur += iStrideCur; uiRowCnt++; } piOrg = pcDtParam->pOrg; piCur = pcDtParam->pCur; iRows = pcDtParam->iRows; iDeltaC = uiRowCnt ? ((iOrigAvg - iCurAvg)/uiRowCnt/48) : 0; for( ; iRows != 0; iRows-=iSubStep ) { uiSum += abs( piOrg[0] - piCur[0] - iDeltaC ); uiSum += abs( piOrg[1] - piCur[1] - iDeltaC ); uiSum += abs( piOrg[2] - piCur[2] - iDeltaC ); uiSum += abs( piOrg[3] - piCur[3] - iDeltaC ); uiSum += abs( piOrg[4] - piCur[4] - iDeltaC ); uiSum += abs( piOrg[5] - piCur[5] - iDeltaC ); uiSum += abs( piOrg[6] - piCur[6] - iDeltaC ); uiSum += abs( piOrg[7] - piCur[7] - iDeltaC ); uiSum += abs( piOrg[8] - piCur[8] - iDeltaC ); uiSum += abs( piOrg[9] - piCur[9] - iDeltaC ); uiSum += abs( piOrg[10] - piCur[10] - iDeltaC ); uiSum += abs( piOrg[11] - piCur[11] - iDeltaC ); uiSum += abs( piOrg[12] - piCur[12] - iDeltaC ); uiSum += abs( piOrg[13] - piCur[13] - iDeltaC ); uiSum += abs( piOrg[14] - piCur[14] - iDeltaC ); uiSum += abs( piOrg[15] - piCur[15] - iDeltaC ); uiSum += abs( piOrg[16] - piCur[16] - iDeltaC ); uiSum += abs( piOrg[17] - piCur[17] - iDeltaC ); uiSum += abs( piOrg[18] - piCur[18] - iDeltaC ); uiSum += abs( piOrg[19] - piCur[19] - iDeltaC ); uiSum += abs( piOrg[20] - piCur[20] - iDeltaC ); uiSum += abs( piOrg[21] - piCur[21] - iDeltaC ); uiSum += abs( piOrg[22] - piCur[22] - iDeltaC ); uiSum += abs( piOrg[23] - piCur[23] - iDeltaC ); uiSum += abs( piOrg[24] - piCur[24] - iDeltaC ); uiSum += abs( piOrg[25] - piCur[25] - iDeltaC ); uiSum += abs( piOrg[26] - piCur[26] - iDeltaC ); uiSum += abs( piOrg[27] - piCur[27] - iDeltaC ); uiSum += abs( piOrg[28] - piCur[28] - iDeltaC ); uiSum += abs( piOrg[29] - piCur[29] - iDeltaC ); uiSum += abs( piOrg[30] - piCur[30] - iDeltaC ); uiSum += abs( piOrg[31] - piCur[31] - iDeltaC ); uiSum += abs( piOrg[32] - piCur[32] - iDeltaC ); uiSum += abs( piOrg[33] - piCur[33] - iDeltaC ); uiSum += abs( piOrg[34] - piCur[34] - iDeltaC ); uiSum += abs( piOrg[35] - piCur[35] - iDeltaC ); uiSum += abs( piOrg[36] - piCur[36] - iDeltaC ); uiSum += abs( piOrg[37] - piCur[37] - iDeltaC ); uiSum += abs( piOrg[38] - piCur[38] - iDeltaC ); uiSum += abs( piOrg[39] - piCur[39] - iDeltaC ); uiSum += abs( piOrg[40] - piCur[40] - iDeltaC ); uiSum += abs( piOrg[41] - piCur[41] - iDeltaC ); uiSum += abs( piOrg[42] - piCur[42] - iDeltaC ); uiSum += abs( piOrg[43] - piCur[43] - iDeltaC ); uiSum += abs( piOrg[44] - piCur[44] - iDeltaC ); uiSum += abs( piOrg[45] - piCur[45] - iDeltaC ); uiSum += abs( piOrg[46] - piCur[46] - iDeltaC ); uiSum += abs( piOrg[47] - piCur[47] - iDeltaC ); piOrg += iStrideOrg; piCur += iStrideCur; } uiSum <<= iSubShift; return ( uiSum >> g_uiBitIncrement ); } #endif #endif // -------------------------------------------------------------------------------------------------------------------- // SSE // -------------------------------------------------------------------------------------------------------------------- #if IBDI_DISTORTION UInt TComRdCost::xGetSSE( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; Int iShift = g_uiBitIncrement; Int iOffset = (g_uiBitIncrement>0)? (1<<(g_uiBitIncrement-1)):0; Int iTemp; for( ; iRows != 0; iRows-- ) { for (Int n = 0; n < iCols; n++ ) { iTemp = ((piOrg[n ]+iOffset)>>iShift) - ((piCur[n ]+iOffset)>>iShift); uiSum += iTemp * iTemp; } piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetSSE4( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; Int iShift = g_uiBitIncrement; Int iOffset = (g_uiBitIncrement>0)? (1<<(g_uiBitIncrement-1)):0; Int iTemp; for( ; iRows != 0; iRows-- ) { iTemp = ((piOrg[0]+iOffset)>>iShift) - ((piCur[0]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[1]+iOffset)>>iShift) - ((piCur[1]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[2]+iOffset)>>iShift) - ((piCur[2]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[3]+iOffset)>>iShift) - ((piCur[3]+iOffset)>>iShift); uiSum += iTemp * iTemp; piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetSSE8( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; Int iShift = g_uiBitIncrement; Int iOffset = (g_uiBitIncrement>0)? (1<<(g_uiBitIncrement-1)):0; Int iTemp; for( ; iRows != 0; iRows-- ) { iTemp = ((piOrg[0]+iOffset)>>iShift) - ((piCur[0]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[1]+iOffset)>>iShift) - ((piCur[1]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[2]+iOffset)>>iShift) - ((piCur[2]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[3]+iOffset)>>iShift) - ((piCur[3]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[4]+iOffset)>>iShift) - ((piCur[4]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[5]+iOffset)>>iShift) - ((piCur[5]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[6]+iOffset)>>iShift) - ((piCur[6]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[7]+iOffset)>>iShift) - ((piCur[7]+iOffset)>>iShift); uiSum += iTemp * iTemp; piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetSSE16( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; Int iShift = g_uiBitIncrement; Int iOffset = (g_uiBitIncrement>0)? (1<<(g_uiBitIncrement-1)):0; Int iTemp; for( ; iRows != 0; iRows-- ) { iTemp = ((piOrg[ 0]+iOffset)>>iShift) - ((piCur[ 0]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 1]+iOffset)>>iShift) - ((piCur[ 1]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 2]+iOffset)>>iShift) - ((piCur[ 2]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 3]+iOffset)>>iShift) - ((piCur[ 3]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 4]+iOffset)>>iShift) - ((piCur[ 4]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 5]+iOffset)>>iShift) - ((piCur[ 5]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 6]+iOffset)>>iShift) - ((piCur[ 6]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 7]+iOffset)>>iShift) - ((piCur[ 7]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 8]+iOffset)>>iShift) - ((piCur[ 8]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 9]+iOffset)>>iShift) - ((piCur[ 9]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[10]+iOffset)>>iShift) - ((piCur[10]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[11]+iOffset)>>iShift) - ((piCur[11]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[12]+iOffset)>>iShift) - ((piCur[12]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[13]+iOffset)>>iShift) - ((piCur[13]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[14]+iOffset)>>iShift) - ((piCur[14]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[15]+iOffset)>>iShift) - ((piCur[15]+iOffset)>>iShift); uiSum += iTemp * iTemp; piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetSSE16N( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; Int iShift = g_uiBitIncrement; Int iOffset = (g_uiBitIncrement>0)? (1<<(g_uiBitIncrement-1)):0; Int iTemp; for( ; iRows != 0; iRows-- ) { for (Int n = 0; n < iCols; n+=16 ) { iTemp = ((piOrg[n+ 0]+iOffset)>>iShift) - ((piCur[n+ 0]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+ 1]+iOffset)>>iShift) - ((piCur[n+ 1]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+ 2]+iOffset)>>iShift) - ((piCur[n+ 2]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+ 3]+iOffset)>>iShift) - ((piCur[n+ 3]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+ 4]+iOffset)>>iShift) - ((piCur[n+ 4]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+ 5]+iOffset)>>iShift) - ((piCur[n+ 5]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+ 6]+iOffset)>>iShift) - ((piCur[n+ 6]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+ 7]+iOffset)>>iShift) - ((piCur[n+ 7]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+ 8]+iOffset)>>iShift) - ((piCur[n+ 8]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+ 9]+iOffset)>>iShift) - ((piCur[n+ 9]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+10]+iOffset)>>iShift) - ((piCur[n+10]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+11]+iOffset)>>iShift) - ((piCur[n+11]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+12]+iOffset)>>iShift) - ((piCur[n+12]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+13]+iOffset)>>iShift) - ((piCur[n+13]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+14]+iOffset)>>iShift) - ((piCur[n+14]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[n+15]+iOffset)>>iShift) - ((piCur[n+15]+iOffset)>>iShift); uiSum += iTemp * iTemp; } piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetSSE32( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; Int iShift = g_uiBitIncrement; Int iOffset = (g_uiBitIncrement>0)? (1<<(g_uiBitIncrement-1)):0; Int iTemp; for( ; iRows != 0; iRows-- ) { iTemp = ((piOrg[ 0]+iOffset)>>iShift) - ((piCur[ 0]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 1]+iOffset)>>iShift) - ((piCur[ 1]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 2]+iOffset)>>iShift) - ((piCur[ 2]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 3]+iOffset)>>iShift) - ((piCur[ 3]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 4]+iOffset)>>iShift) - ((piCur[ 4]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 5]+iOffset)>>iShift) - ((piCur[ 5]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 6]+iOffset)>>iShift) - ((piCur[ 6]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 7]+iOffset)>>iShift) - ((piCur[ 7]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 8]+iOffset)>>iShift) - ((piCur[ 8]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 9]+iOffset)>>iShift) - ((piCur[ 9]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[10]+iOffset)>>iShift) - ((piCur[10]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[11]+iOffset)>>iShift) - ((piCur[11]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[12]+iOffset)>>iShift) - ((piCur[12]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[13]+iOffset)>>iShift) - ((piCur[13]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[14]+iOffset)>>iShift) - ((piCur[14]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[15]+iOffset)>>iShift) - ((piCur[15]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[16]+iOffset)>>iShift) - ((piCur[16]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[17]+iOffset)>>iShift) - ((piCur[17]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[18]+iOffset)>>iShift) - ((piCur[18]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[19]+iOffset)>>iShift) - ((piCur[19]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[20]+iOffset)>>iShift) - ((piCur[20]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[21]+iOffset)>>iShift) - ((piCur[21]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[22]+iOffset)>>iShift) - ((piCur[22]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[23]+iOffset)>>iShift) - ((piCur[23]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[24]+iOffset)>>iShift) - ((piCur[24]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[25]+iOffset)>>iShift) - ((piCur[25]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[26]+iOffset)>>iShift) - ((piCur[26]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[27]+iOffset)>>iShift) - ((piCur[27]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[28]+iOffset)>>iShift) - ((piCur[28]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[29]+iOffset)>>iShift) - ((piCur[29]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[30]+iOffset)>>iShift) - ((piCur[30]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[31]+iOffset)>>iShift) - ((piCur[31]+iOffset)>>iShift); uiSum += iTemp * iTemp; piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetSSE64( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; Int iShift = g_uiBitIncrement; Int iOffset = (g_uiBitIncrement>0)? (1<<(g_uiBitIncrement-1)):0; Int iTemp; for( ; iRows != 0; iRows-- ) { iTemp = ((piOrg[ 0]+iOffset)>>iShift) - ((piCur[ 0]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 1]+iOffset)>>iShift) - ((piCur[ 1]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 2]+iOffset)>>iShift) - ((piCur[ 2]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 3]+iOffset)>>iShift) - ((piCur[ 3]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 4]+iOffset)>>iShift) - ((piCur[ 4]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 5]+iOffset)>>iShift) - ((piCur[ 5]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 6]+iOffset)>>iShift) - ((piCur[ 6]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 7]+iOffset)>>iShift) - ((piCur[ 7]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 8]+iOffset)>>iShift) - ((piCur[ 8]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[ 9]+iOffset)>>iShift) - ((piCur[ 9]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[10]+iOffset)>>iShift) - ((piCur[10]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[11]+iOffset)>>iShift) - ((piCur[11]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[12]+iOffset)>>iShift) - ((piCur[12]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[13]+iOffset)>>iShift) - ((piCur[13]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[14]+iOffset)>>iShift) - ((piCur[14]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[15]+iOffset)>>iShift) - ((piCur[15]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[16]+iOffset)>>iShift) - ((piCur[16]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[17]+iOffset)>>iShift) - ((piCur[17]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[18]+iOffset)>>iShift) - ((piCur[18]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[19]+iOffset)>>iShift) - ((piCur[19]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[20]+iOffset)>>iShift) - ((piCur[20]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[21]+iOffset)>>iShift) - ((piCur[21]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[22]+iOffset)>>iShift) - ((piCur[22]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[23]+iOffset)>>iShift) - ((piCur[23]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[24]+iOffset)>>iShift) - ((piCur[24]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[25]+iOffset)>>iShift) - ((piCur[25]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[26]+iOffset)>>iShift) - ((piCur[26]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[27]+iOffset)>>iShift) - ((piCur[27]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[28]+iOffset)>>iShift) - ((piCur[28]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[29]+iOffset)>>iShift) - ((piCur[29]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[30]+iOffset)>>iShift) - ((piCur[30]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[31]+iOffset)>>iShift) - ((piCur[31]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[32]+iOffset)>>iShift) - ((piCur[32]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[33]+iOffset)>>iShift) - ((piCur[33]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[34]+iOffset)>>iShift) - ((piCur[34]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[35]+iOffset)>>iShift) - ((piCur[35]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[36]+iOffset)>>iShift) - ((piCur[36]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[37]+iOffset)>>iShift) - ((piCur[37]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[38]+iOffset)>>iShift) - ((piCur[38]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[39]+iOffset)>>iShift) - ((piCur[39]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[40]+iOffset)>>iShift) - ((piCur[40]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[41]+iOffset)>>iShift) - ((piCur[41]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[42]+iOffset)>>iShift) - ((piCur[42]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[43]+iOffset)>>iShift) - ((piCur[43]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[44]+iOffset)>>iShift) - ((piCur[44]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[45]+iOffset)>>iShift) - ((piCur[45]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[46]+iOffset)>>iShift) - ((piCur[46]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[47]+iOffset)>>iShift) - ((piCur[47]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[48]+iOffset)>>iShift) - ((piCur[48]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[49]+iOffset)>>iShift) - ((piCur[49]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[50]+iOffset)>>iShift) - ((piCur[50]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[51]+iOffset)>>iShift) - ((piCur[51]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[52]+iOffset)>>iShift) - ((piCur[52]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[53]+iOffset)>>iShift) - ((piCur[53]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[54]+iOffset)>>iShift) - ((piCur[54]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[55]+iOffset)>>iShift) - ((piCur[55]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[56]+iOffset)>>iShift) - ((piCur[56]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[57]+iOffset)>>iShift) - ((piCur[57]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[58]+iOffset)>>iShift) - ((piCur[58]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[59]+iOffset)>>iShift) - ((piCur[59]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[60]+iOffset)>>iShift) - ((piCur[60]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[61]+iOffset)>>iShift) - ((piCur[61]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[62]+iOffset)>>iShift) - ((piCur[62]+iOffset)>>iShift); uiSum += iTemp * iTemp; iTemp = ((piOrg[63]+iOffset)>>iShift) - ((piCur[63]+iOffset)>>iShift); uiSum += iTemp * iTemp; piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } #else UInt TComRdCost::xGetSSE( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSSEw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int iTemp; #if HHI_INTERVIEW_SKIP if( pcDtParam->pUsed ) { Pel* piUsed = pcDtParam->pUsed; Int iStrideUsed = pcDtParam->iStrideUsed; for( ; iRows != 0; iRows-- ) { for (Int n = 0; n < iCols; n++ ) { if( piUsed[n] ) { iTemp = piOrg[n ] - piCur[n ]; uiSum += ( iTemp * iTemp ) >> uiShift; } } piOrg += iStrideOrg; piCur += iStrideCur; piUsed += iStrideUsed; } } else { #endif for( ; iRows != 0; iRows-- ) { for (Int n = 0; n < iCols; n++ ) { iTemp = piOrg[n ] - piCur[n ]; uiSum += ( iTemp * iTemp ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; } #if HHI_INTERVIEW_SKIP } #endif return ( uiSum ); } UInt TComRdCost::xGetSSE4( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { assert( pcDtParam->iCols == 4 ); return xGetSSEw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int iTemp; #if HHI_INTERVIEW_SKIP if( pcDtParam->pUsed ) { Pel* piUsed = pcDtParam->pUsed; Int iStrideUsed = pcDtParam->iStrideUsed; for( ; iRows != 0; iRows-- ) { if( piUsed[0] ) { iTemp = piOrg[0] - piCur[0]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[1] ) { iTemp = piOrg[1] - piCur[1]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[2] ) { iTemp = piOrg[2] - piCur[2]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[3] ) { iTemp = piOrg[3] - piCur[3]; uiSum += ( iTemp * iTemp ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; piUsed += iStrideUsed; } } else { #endif for( ; iRows != 0; iRows-- ) { iTemp = piOrg[0] - piCur[0]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[1] - piCur[1]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[2] - piCur[2]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[3] - piCur[3]; uiSum += ( iTemp * iTemp ) >> uiShift; piOrg += iStrideOrg; piCur += iStrideCur; } #if HHI_INTERVIEW_SKIP } #endif return ( uiSum ); } UInt TComRdCost::xGetSSE8( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { assert( pcDtParam->iCols == 8 ); return xGetSSEw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int iTemp; #if HHI_INTERVIEW_SKIP if( pcDtParam->pUsed ) { Pel* piUsed = pcDtParam->pUsed; Int iStrideUsed = pcDtParam->iStrideUsed; for( ; iRows != 0; iRows-- ) { if( piUsed[0] ) { iTemp = piOrg[0] - piCur[0]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[1] ) { iTemp = piOrg[1] - piCur[1]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[2] ) { iTemp = piOrg[2] - piCur[2]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[3] ) { iTemp = piOrg[3] - piCur[3]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[4] ) { iTemp = piOrg[4] - piCur[4]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[5] ) { iTemp = piOrg[5] - piCur[5]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[6] ) { iTemp = piOrg[6] - piCur[6]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[7] ) { iTemp = piOrg[7] - piCur[7]; uiSum += ( iTemp * iTemp ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; piUsed += iStrideUsed; } } else { #endif for( ; iRows != 0; iRows-- ) { iTemp = piOrg[0] - piCur[0]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[1] - piCur[1]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[2] - piCur[2]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[3] - piCur[3]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[4] - piCur[4]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[5] - piCur[5]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[6] - piCur[6]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[7] - piCur[7]; uiSum += ( iTemp * iTemp ) >> uiShift; piOrg += iStrideOrg; piCur += iStrideCur; } #if HHI_INTERVIEW_SKIP } #endif return ( uiSum ); } UInt TComRdCost::xGetSSE16( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { assert( pcDtParam->iCols == 16 ); return xGetSSEw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int iTemp; #if HHI_INTERVIEW_SKIP if( pcDtParam->pUsed ) { Pel* piUsed = pcDtParam->pUsed; Int iStrideUsed = pcDtParam->iStrideUsed; for( ; iRows != 0; iRows-- ) { if( piUsed[ 0] ) { iTemp = piOrg[ 0] - piCur[ 0]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 1] ) { iTemp = piOrg[ 1] - piCur[ 1]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 2] ) { iTemp = piOrg[ 2] - piCur[ 2]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 3] ) { iTemp = piOrg[ 3] - piCur[ 3]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 4] ) { iTemp = piOrg[ 4] - piCur[ 4]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 5] ) { iTemp = piOrg[ 5] - piCur[ 5]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 6] ) { iTemp = piOrg[ 6] - piCur[ 6]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 7] ) { iTemp = piOrg[ 7] - piCur[ 7]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 8] ) { iTemp = piOrg[ 8] - piCur[ 8]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 9] ) { iTemp = piOrg[ 9] - piCur[ 9]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[10] ) { iTemp = piOrg[10] - piCur[10]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[11] ) { iTemp = piOrg[11] - piCur[11]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[12] ) { iTemp = piOrg[12] - piCur[12]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[13] ) { iTemp = piOrg[13] - piCur[13]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[14] ) { iTemp = piOrg[14] - piCur[14]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[15] ) { iTemp = piOrg[15] - piCur[15]; uiSum += ( iTemp * iTemp ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; piUsed += iStrideUsed; } } else { #endif for( ; iRows != 0; iRows-- ) { iTemp = piOrg[ 0] - piCur[ 0]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 1] - piCur[ 1]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 2] - piCur[ 2]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 3] - piCur[ 3]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 4] - piCur[ 4]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 5] - piCur[ 5]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 6] - piCur[ 6]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 7] - piCur[ 7]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 8] - piCur[ 8]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 9] - piCur[ 9]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[10] - piCur[10]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[11] - piCur[11]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[12] - piCur[12]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[13] - piCur[13]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[14] - piCur[14]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[15] - piCur[15]; uiSum += ( iTemp * iTemp ) >> uiShift; piOrg += iStrideOrg; piCur += iStrideCur; } #if HHI_INTERVIEW_SKIP } #endif return ( uiSum ); } UInt TComRdCost::xGetSSE16N( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetSSEw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int iTemp; #if HHI_INTERVIEW_SKIP if( pcDtParam->pUsed ) { Pel* piUsed = pcDtParam->pUsed; Int iStrideUsed = pcDtParam->iStrideUsed; for( ; iRows != 0; iRows-- ) { for (Int n = 0; n < iCols; n+=16 ) { if( piUsed[n+ 0] ) { iTemp = piOrg[n+ 0] - piCur[n+ 0]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+ 1] ) { iTemp = piOrg[n+ 1] - piCur[n+ 1]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+ 2] ) { iTemp = piOrg[n+ 2] - piCur[n+ 2]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+ 3] ) { iTemp = piOrg[n+ 3] - piCur[n+ 3]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+ 4] ) { iTemp = piOrg[n+ 4] - piCur[n+ 4]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+ 5] ) { iTemp = piOrg[n+ 5] - piCur[n+ 5]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+ 6] ) { iTemp = piOrg[n+ 6] - piCur[n+ 6]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+ 7] ) { iTemp = piOrg[n+ 7] - piCur[n+ 7]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+ 8] ) { iTemp = piOrg[n+ 8] - piCur[n+ 8]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+ 9] ) { iTemp = piOrg[n+ 9] - piCur[n+ 9]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+10] ) { iTemp = piOrg[n+10] - piCur[n+10]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+11] ) { iTemp = piOrg[n+11] - piCur[n+11]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+12] ) { iTemp = piOrg[n+12] - piCur[n+12]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+13] ) { iTemp = piOrg[n+13] - piCur[n+13]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+14] ) { iTemp = piOrg[n+14] - piCur[n+14]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[n+15] ) { iTemp = piOrg[n+15] - piCur[n+15]; uiSum += ( iTemp * iTemp ) >> uiShift; } } piOrg += iStrideOrg; piCur += iStrideCur; piUsed += iStrideUsed; } } else { #endif for( ; iRows != 0; iRows-- ) { for (Int n = 0; n < iCols; n+=16 ) { iTemp = piOrg[n+ 0] - piCur[n+ 0]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+ 1] - piCur[n+ 1]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+ 2] - piCur[n+ 2]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+ 3] - piCur[n+ 3]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+ 4] - piCur[n+ 4]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+ 5] - piCur[n+ 5]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+ 6] - piCur[n+ 6]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+ 7] - piCur[n+ 7]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+ 8] - piCur[n+ 8]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+ 9] - piCur[n+ 9]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+10] - piCur[n+10]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+11] - piCur[n+11]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+12] - piCur[n+12]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+13] - piCur[n+13]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+14] - piCur[n+14]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[n+15] - piCur[n+15]; uiSum += ( iTemp * iTemp ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; } #if HHI_INTERVIEW_SKIP } #endif return ( uiSum ); } UInt TComRdCost::xGetSSE32( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { assert( pcDtParam->iCols == 32 ); return xGetSSEw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int iTemp; #if HHI_INTERVIEW_SKIP if( pcDtParam->pUsed ) { Pel* piUsed = pcDtParam->pUsed; Int iStrideUsed = pcDtParam->iStrideUsed; for( ; iRows != 0; iRows-- ) { if( piUsed[ 0] ) { iTemp = piOrg[ 0] - piCur[ 0]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 1] ) { iTemp = piOrg[ 1] - piCur[ 1]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 2] ) { iTemp = piOrg[ 2] - piCur[ 2]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 3] ) { iTemp = piOrg[ 3] - piCur[ 3]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 4] ) { iTemp = piOrg[ 4] - piCur[ 4]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 5] ) { iTemp = piOrg[ 5] - piCur[ 5]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 6] ) { iTemp = piOrg[ 6] - piCur[ 6]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 7] ) { iTemp = piOrg[ 7] - piCur[ 7]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 8] ) { iTemp = piOrg[ 8] - piCur[ 8]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 9] ) { iTemp = piOrg[ 9] - piCur[ 9]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[10] ) { iTemp = piOrg[10] - piCur[10]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[11] ) { iTemp = piOrg[11] - piCur[11]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[12] ) { iTemp = piOrg[12] - piCur[12]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[13] ) { iTemp = piOrg[13] - piCur[13]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[14] ) { iTemp = piOrg[14] - piCur[14]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[15] ) { iTemp = piOrg[15] - piCur[15]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[16] ) { iTemp = piOrg[16] - piCur[16]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[17] ) { iTemp = piOrg[17] - piCur[17]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[18] ) { iTemp = piOrg[18] - piCur[18]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[19] ) { iTemp = piOrg[19] - piCur[19]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[20] ) { iTemp = piOrg[20] - piCur[20]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[21] ) { iTemp = piOrg[21] - piCur[21]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[22] ) { iTemp = piOrg[22] - piCur[22]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[23] ) { iTemp = piOrg[23] - piCur[23]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[24] ) { iTemp = piOrg[24] - piCur[24]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[25] ) { iTemp = piOrg[25] - piCur[25]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[26] ) { iTemp = piOrg[26] - piCur[26]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[27] ) { iTemp = piOrg[27] - piCur[27]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[28] ) { iTemp = piOrg[28] - piCur[28]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[29] ) { iTemp = piOrg[29] - piCur[29]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[30] ) { iTemp = piOrg[30] - piCur[30]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[31] ) { iTemp = piOrg[31] - piCur[31]; uiSum += ( iTemp * iTemp ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; piUsed += iStrideUsed; } } else { #endif for( ; iRows != 0; iRows-- ) { iTemp = piOrg[ 0] - piCur[ 0]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 1] - piCur[ 1]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 2] - piCur[ 2]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 3] - piCur[ 3]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 4] - piCur[ 4]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 5] - piCur[ 5]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 6] - piCur[ 6]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 7] - piCur[ 7]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 8] - piCur[ 8]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 9] - piCur[ 9]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[10] - piCur[10]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[11] - piCur[11]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[12] - piCur[12]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[13] - piCur[13]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[14] - piCur[14]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[15] - piCur[15]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[16] - piCur[16]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[17] - piCur[17]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[18] - piCur[18]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[19] - piCur[19]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[20] - piCur[20]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[21] - piCur[21]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[22] - piCur[22]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[23] - piCur[23]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[24] - piCur[24]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[25] - piCur[25]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[26] - piCur[26]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[27] - piCur[27]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[28] - piCur[28]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[29] - piCur[29]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[30] - piCur[30]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[31] - piCur[31]; uiSum += ( iTemp * iTemp ) >> uiShift; piOrg += iStrideOrg; piCur += iStrideCur; } #if HHI_INTERVIEW_SKIP } #endif return ( uiSum ); } UInt TComRdCost::xGetSSE64( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { assert( pcDtParam->iCols == 64 ); return xGetSSEw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int iTemp; #if HHI_INTERVIEW_SKIP if( pcDtParam->pUsed ) { Pel* piUsed = pcDtParam->pUsed; Int iStrideUsed = pcDtParam->iStrideUsed; for( ; iRows != 0; iRows-- ) { if( piUsed[ 0] ) { iTemp = piOrg[ 0] - piCur[ 0]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 1] ) { iTemp = piOrg[ 1] - piCur[ 1]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 2] ) { iTemp = piOrg[ 2] - piCur[ 2]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 3] ) { iTemp = piOrg[ 3] - piCur[ 3]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 4] ) { iTemp = piOrg[ 4] - piCur[ 4]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 5] ) { iTemp = piOrg[ 5] - piCur[ 5]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 6] ) { iTemp = piOrg[ 6] - piCur[ 6]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 7] ) { iTemp = piOrg[ 7] - piCur[ 7]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 8] ) { iTemp = piOrg[ 8] - piCur[ 8]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[ 9] ) { iTemp = piOrg[ 9] - piCur[ 9]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[10] ) { iTemp = piOrg[10] - piCur[10]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[11] ) { iTemp = piOrg[11] - piCur[11]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[12] ) { iTemp = piOrg[12] - piCur[12]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[13] ) { iTemp = piOrg[13] - piCur[13]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[14] ) { iTemp = piOrg[14] - piCur[14]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[15] ) { iTemp = piOrg[15] - piCur[15]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[16] ) { iTemp = piOrg[16] - piCur[16]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[17] ) { iTemp = piOrg[17] - piCur[17]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[18] ) { iTemp = piOrg[18] - piCur[18]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[19] ) { iTemp = piOrg[19] - piCur[19]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[20] ) { iTemp = piOrg[20] - piCur[20]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[21] ) { iTemp = piOrg[21] - piCur[21]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[22] ) { iTemp = piOrg[22] - piCur[22]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[23] ) { iTemp = piOrg[23] - piCur[23]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[24] ) { iTemp = piOrg[24] - piCur[24]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[25] ) { iTemp = piOrg[25] - piCur[25]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[26] ) { iTemp = piOrg[26] - piCur[26]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[27] ) { iTemp = piOrg[27] - piCur[27]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[28] ) { iTemp = piOrg[28] - piCur[28]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[29] ) { iTemp = piOrg[29] - piCur[29]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[30] ) { iTemp = piOrg[30] - piCur[30]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[31] ) { iTemp = piOrg[31] - piCur[31]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[32] ) { iTemp = piOrg[32] - piCur[32]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[33] ) { iTemp = piOrg[33] - piCur[33]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[34] ) { iTemp = piOrg[34] - piCur[34]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[35] ) { iTemp = piOrg[35] - piCur[35]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[36] ) { iTemp = piOrg[36] - piCur[36]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[37] ) { iTemp = piOrg[37] - piCur[37]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[38] ) { iTemp = piOrg[38] - piCur[38]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[39] ) { iTemp = piOrg[39] - piCur[39]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[40] ) { iTemp = piOrg[40] - piCur[40]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[41] ) { iTemp = piOrg[41] - piCur[41]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[42] ) { iTemp = piOrg[42] - piCur[42]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[43] ) { iTemp = piOrg[43] - piCur[43]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[44] ) { iTemp = piOrg[44] - piCur[44]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[45] ) { iTemp = piOrg[45] - piCur[45]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[46] ) { iTemp = piOrg[46] - piCur[46]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[47] ) { iTemp = piOrg[47] - piCur[47]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[48] ) { iTemp = piOrg[48] - piCur[48]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[49] ) { iTemp = piOrg[49] - piCur[49]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[50] ) { iTemp = piOrg[50] - piCur[50]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[51] ) { iTemp = piOrg[51] - piCur[51]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[52] ) { iTemp = piOrg[52] - piCur[52]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[53] ) { iTemp = piOrg[53] - piCur[53]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[54] ) { iTemp = piOrg[54] - piCur[54]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[55] ) { iTemp = piOrg[55] - piCur[55]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[56] ) { iTemp = piOrg[56] - piCur[56]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[57] ) { iTemp = piOrg[57] - piCur[57]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[58] ) { iTemp = piOrg[58] - piCur[58]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[59] ) { iTemp = piOrg[59] - piCur[59]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[60] ) { iTemp = piOrg[60] - piCur[60]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[61] ) { iTemp = piOrg[61] - piCur[61]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[62] ) { iTemp = piOrg[62] - piCur[62]; uiSum += ( iTemp * iTemp ) >> uiShift; } if( piUsed[63] ) { iTemp = piOrg[63] - piCur[63]; uiSum += ( iTemp * iTemp ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; piUsed += iStrideUsed; } } else { #endif for( ; iRows != 0; iRows-- ) { iTemp = piOrg[ 0] - piCur[ 0]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 1] - piCur[ 1]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 2] - piCur[ 2]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 3] - piCur[ 3]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 4] - piCur[ 4]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 5] - piCur[ 5]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 6] - piCur[ 6]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 7] - piCur[ 7]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 8] - piCur[ 8]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[ 9] - piCur[ 9]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[10] - piCur[10]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[11] - piCur[11]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[12] - piCur[12]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[13] - piCur[13]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[14] - piCur[14]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[15] - piCur[15]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[16] - piCur[16]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[17] - piCur[17]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[18] - piCur[18]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[19] - piCur[19]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[20] - piCur[20]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[21] - piCur[21]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[22] - piCur[22]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[23] - piCur[23]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[24] - piCur[24]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[25] - piCur[25]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[26] - piCur[26]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[27] - piCur[27]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[28] - piCur[28]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[29] - piCur[29]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[30] - piCur[30]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[31] - piCur[31]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[32] - piCur[32]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[33] - piCur[33]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[34] - piCur[34]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[35] - piCur[35]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[36] - piCur[36]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[37] - piCur[37]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[38] - piCur[38]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[39] - piCur[39]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[40] - piCur[40]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[41] - piCur[41]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[42] - piCur[42]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[43] - piCur[43]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[44] - piCur[44]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[45] - piCur[45]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[46] - piCur[46]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[47] - piCur[47]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[48] - piCur[48]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[49] - piCur[49]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[50] - piCur[50]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[51] - piCur[51]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[52] - piCur[52]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[53] - piCur[53]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[54] - piCur[54]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[55] - piCur[55]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[56] - piCur[56]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[57] - piCur[57]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[58] - piCur[58]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[59] - piCur[59]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[60] - piCur[60]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[61] - piCur[61]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[62] - piCur[62]; uiSum += ( iTemp * iTemp ) >> uiShift; iTemp = piOrg[63] - piCur[63]; uiSum += ( iTemp * iTemp ) >> uiShift; piOrg += iStrideOrg; piCur += iStrideCur; } #if HHI_INTERVIEW_SKIP } #endif return ( uiSum ); } #endif #if SAIT_VSO_EST_A0033 UInt TComRdCost::getVSDEstimate( Int dDM, Pel* pOrg, Int iOrgStride, Pel* pVirRec, Pel* pVirOrg, Int iVirStride, Int x, Int y ) { Double dD; Int iTemp; dD = ( (Double) ( dDM >> g_uiBitIncrement ) ) * m_dDisparityCoeff; iTemp = (Int) ROUND( 0.5 * fabs(dD) * ( abs( (Int) pVirRec[ x+y*iVirStride ] - (Int) pVirRec[ x-1+y*iVirStride ] ) + abs( (Int) pVirRec[ x+y*iVirStride ] - (Int) pVirRec[ x+1+y*iVirStride ] ) ) ); return (UInt) ( (iTemp*iTemp)>>1 ); } UInt TComRdCost::xGetVSD( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Pel* piVirRec = pcDtParam->pVirRec; Pel* piVirOrg = pcDtParam->pVirOrg; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideVir = pcDtParam->iStrideVir; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int dDM; for ( Int y = 0 ; y < iRows ; y++ ) { for (Int x = 0; x < iCols; x++ ) { dDM = (Int) ( piOrg[x ] - piCur[x ] ); uiSum += getVSDEstimate( dDM, piOrg, iStrideOrg, piVirRec, piVirOrg, iStrideVir, x, y ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetVSD4( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Pel* piVirRec = pcDtParam->pVirRec; Pel* piVirOrg = pcDtParam->pVirOrg; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideVir = pcDtParam->iStrideVir; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int dDM; for ( Int y = 0 ; y < iRows ; y++ ) { dDM = (Int) ( piOrg[0] - piCur[0] ); uiSum += ( getVSDEstimate( dDM, piOrg, iStrideOrg, piVirRec, piVirOrg, iStrideVir, 0, y ) ) >> uiShift; dDM = (Int) ( piOrg[1] - piCur[1] ); uiSum += ( getVSDEstimate( dDM, piOrg, iStrideOrg, piVirRec, piVirOrg, iStrideVir, 1, y ) ) >> uiShift; dDM = (Int) ( piOrg[2] - piCur[2] ); uiSum += ( getVSDEstimate( dDM, piOrg, iStrideOrg, piVirRec, piVirOrg, iStrideVir, 2, y ) ) >> uiShift; dDM = (Int) ( piOrg[3] - piCur[3] ); uiSum += ( getVSDEstimate( dDM, piOrg, iStrideOrg, piVirRec, piVirOrg, iStrideVir, 3, y ) ) >> uiShift; piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetVSD8( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Pel* piVirRec = pcDtParam->pVirRec; Pel* piVirOrg = pcDtParam->pVirOrg; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideVir = pcDtParam->iStrideVir; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int dDM; for ( Int y = 0 ; y < iRows ; y++ ) { for (Int x = 0; x < 8; x++ ) { dDM = (Int) ( piOrg[x] - piCur[x] ); uiSum += getVSDEstimate( dDM, piOrg, iStrideOrg, piVirRec, piVirOrg, iStrideVir, x, y ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetVSD16( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Pel* piVirRec = pcDtParam->pVirRec; Pel* piVirOrg = pcDtParam->pVirOrg; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideVir = pcDtParam->iStrideVir; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int dDM; for ( Int y = 0 ; y < iRows ; y++ ) { for (Int x = 0; x < 16; x++ ) { dDM = (Int) ( piOrg[x] - piCur[x] ); uiSum += getVSDEstimate( dDM, piOrg, iStrideOrg, piVirRec, piVirOrg, iStrideVir, x, y ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetVSD16N( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Pel* piVirRec = pcDtParam->pVirRec; Pel* piVirOrg = pcDtParam->pVirOrg; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideVir = pcDtParam->iStrideVir; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int dDM; for ( Int y = 0 ; y < iRows ; y++ ) { for (Int x = 0; x < iCols; x+=16 ) { for ( Int k = 0 ; k < 16 ; k++ ) { dDM = (Int) ( piOrg[x+k] - piCur[x+k] ); uiSum += getVSDEstimate( dDM, piOrg, iStrideOrg, piVirRec, piVirOrg, iStrideVir, x+k, y ) >> uiShift; } } piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetVSD32( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Pel* piVirRec = pcDtParam->pVirRec; Pel* piVirOrg = pcDtParam->pVirOrg; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideVir = pcDtParam->iStrideVir; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int dDM; for ( Int y = 0 ; y < iRows ; y++ ) { for (Int x = 0; x < 32 ; x++ ) { dDM = (Int) ( piOrg[x] - piCur[x] ); uiSum += getVSDEstimate( dDM, piOrg, iStrideOrg, piVirRec, piVirOrg, iStrideVir, x, y ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } UInt TComRdCost::xGetVSD64( DistParam* pcDtParam ) { Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Pel* piVirRec = pcDtParam->pVirRec; Pel* piVirOrg = pcDtParam->pVirOrg; Int iRows = pcDtParam->iRows; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideVir = pcDtParam->iStrideVir; UInt uiSum = 0; UInt uiShift = g_uiBitIncrement<<1; Int dDM; for ( Int y = 0 ; y < iRows ; y++ ) { for (Int x = 0; x < 64; x++ ) { dDM = (Int) ( piOrg[x] - piCur[x] ); uiSum += getVSDEstimate( dDM, piOrg, iStrideOrg, piVirRec, piVirOrg, iStrideVir, x, y ) >> uiShift; } piOrg += iStrideOrg; piCur += iStrideCur; } return ( uiSum ); } #endif // -------------------------------------------------------------------------------------------------------------------- // HADAMARD with step (used in fractional search) // -------------------------------------------------------------------------------------------------------------------- UInt TComRdCost::xCalcHADs2x2( Pel *piOrg, Pel *piCur, Int iStrideOrg, Int iStrideCur, Int iStep ) { Int satd = 0, diff[4], m[4]; assert( iStep == 1 ); diff[0] = piOrg[0 ] - piCur[0]; diff[1] = piOrg[1 ] - piCur[1]; diff[2] = piOrg[iStrideOrg ] - piCur[0 + iStrideCur]; diff[3] = piOrg[iStrideOrg + 1] - piCur[1 + iStrideCur]; m[0] = diff[0] + diff[2]; m[1] = diff[1] + diff[3]; m[2] = diff[0] - diff[2]; m[3] = diff[1] - diff[3]; satd += abs(m[0] + m[1]); satd += abs(m[0] - m[1]); satd += abs(m[2] + m[3]); satd += abs(m[2] - m[3]); return satd; } UInt TComRdCost::xCalcHADs4x4( Pel *piOrg, Pel *piCur, Int iStrideOrg, Int iStrideCur, Int iStep ) { Int k, satd = 0, diff[16], m[16], d[16]; assert( iStep == 1 ); for( k = 0; k < 16; k+=4 ) { diff[k+0] = piOrg[0] - piCur[0]; diff[k+1] = piOrg[1] - piCur[1]; diff[k+2] = piOrg[2] - piCur[2]; diff[k+3] = piOrg[3] - piCur[3]; piCur += iStrideCur; piOrg += iStrideOrg; } /*===== hadamard transform =====*/ m[ 0] = diff[ 0] + diff[12]; m[ 1] = diff[ 1] + diff[13]; m[ 2] = diff[ 2] + diff[14]; m[ 3] = diff[ 3] + diff[15]; m[ 4] = diff[ 4] + diff[ 8]; m[ 5] = diff[ 5] + diff[ 9]; m[ 6] = diff[ 6] + diff[10]; m[ 7] = diff[ 7] + diff[11]; m[ 8] = diff[ 4] - diff[ 8]; m[ 9] = diff[ 5] - diff[ 9]; m[10] = diff[ 6] - diff[10]; m[11] = diff[ 7] - diff[11]; m[12] = diff[ 0] - diff[12]; m[13] = diff[ 1] - diff[13]; m[14] = diff[ 2] - diff[14]; m[15] = diff[ 3] - diff[15]; d[ 0] = m[ 0] + m[ 4]; d[ 1] = m[ 1] + m[ 5]; d[ 2] = m[ 2] + m[ 6]; d[ 3] = m[ 3] + m[ 7]; d[ 4] = m[ 8] + m[12]; d[ 5] = m[ 9] + m[13]; d[ 6] = m[10] + m[14]; d[ 7] = m[11] + m[15]; d[ 8] = m[ 0] - m[ 4]; d[ 9] = m[ 1] - m[ 5]; d[10] = m[ 2] - m[ 6]; d[11] = m[ 3] - m[ 7]; d[12] = m[12] - m[ 8]; d[13] = m[13] - m[ 9]; d[14] = m[14] - m[10]; d[15] = m[15] - m[11]; m[ 0] = d[ 0] + d[ 3]; m[ 1] = d[ 1] + d[ 2]; m[ 2] = d[ 1] - d[ 2]; m[ 3] = d[ 0] - d[ 3]; m[ 4] = d[ 4] + d[ 7]; m[ 5] = d[ 5] + d[ 6]; m[ 6] = d[ 5] - d[ 6]; m[ 7] = d[ 4] - d[ 7]; m[ 8] = d[ 8] + d[11]; m[ 9] = d[ 9] + d[10]; m[10] = d[ 9] - d[10]; m[11] = d[ 8] - d[11]; m[12] = d[12] + d[15]; m[13] = d[13] + d[14]; m[14] = d[13] - d[14]; m[15] = d[12] - d[15]; d[ 0] = m[ 0] + m[ 1]; d[ 1] = m[ 0] - m[ 1]; d[ 2] = m[ 2] + m[ 3]; d[ 3] = m[ 3] - m[ 2]; d[ 4] = m[ 4] + m[ 5]; d[ 5] = m[ 4] - m[ 5]; d[ 6] = m[ 6] + m[ 7]; d[ 7] = m[ 7] - m[ 6]; d[ 8] = m[ 8] + m[ 9]; d[ 9] = m[ 8] - m[ 9]; d[10] = m[10] + m[11]; d[11] = m[11] - m[10]; d[12] = m[12] + m[13]; d[13] = m[12] - m[13]; d[14] = m[14] + m[15]; d[15] = m[15] - m[14]; for (k=0; k<16; ++k) { satd += abs(d[k]); } satd = ((satd+1)>>1); return satd; } UInt TComRdCost::xCalcHADs8x8( Pel *piOrg, Pel *piCur, Int iStrideOrg, Int iStrideCur, Int iStep ) { Int k, i, j, jj, sad=0; Int diff[64], m1[8][8], m2[8][8], m3[8][8]; assert( iStep == 1 ); for( k = 0; k < 64; k += 8 ) { diff[k+0] = piOrg[0] - piCur[0]; diff[k+1] = piOrg[1] - piCur[1]; diff[k+2] = piOrg[2] - piCur[2]; diff[k+3] = piOrg[3] - piCur[3]; diff[k+4] = piOrg[4] - piCur[4]; diff[k+5] = piOrg[5] - piCur[5]; diff[k+6] = piOrg[6] - piCur[6]; diff[k+7] = piOrg[7] - piCur[7]; piCur += iStrideCur; piOrg += iStrideOrg; } //horizontal for (j=0; j < 8; j++) { jj = j << 3; m2[j][0] = diff[jj ] + diff[jj+4]; m2[j][1] = diff[jj+1] + diff[jj+5]; m2[j][2] = diff[jj+2] + diff[jj+6]; m2[j][3] = diff[jj+3] + diff[jj+7]; m2[j][4] = diff[jj ] - diff[jj+4]; m2[j][5] = diff[jj+1] - diff[jj+5]; m2[j][6] = diff[jj+2] - diff[jj+6]; m2[j][7] = diff[jj+3] - diff[jj+7]; m1[j][0] = m2[j][0] + m2[j][2]; m1[j][1] = m2[j][1] + m2[j][3]; m1[j][2] = m2[j][0] - m2[j][2]; m1[j][3] = m2[j][1] - m2[j][3]; m1[j][4] = m2[j][4] + m2[j][6]; m1[j][5] = m2[j][5] + m2[j][7]; m1[j][6] = m2[j][4] - m2[j][6]; m1[j][7] = m2[j][5] - m2[j][7]; m2[j][0] = m1[j][0] + m1[j][1]; m2[j][1] = m1[j][0] - m1[j][1]; m2[j][2] = m1[j][2] + m1[j][3]; m2[j][3] = m1[j][2] - m1[j][3]; m2[j][4] = m1[j][4] + m1[j][5]; m2[j][5] = m1[j][4] - m1[j][5]; m2[j][6] = m1[j][6] + m1[j][7]; m2[j][7] = m1[j][6] - m1[j][7]; } //vertical for (i=0; i < 8; i++) { m3[0][i] = m2[0][i] + m2[4][i]; m3[1][i] = m2[1][i] + m2[5][i]; m3[2][i] = m2[2][i] + m2[6][i]; m3[3][i] = m2[3][i] + m2[7][i]; m3[4][i] = m2[0][i] - m2[4][i]; m3[5][i] = m2[1][i] - m2[5][i]; m3[6][i] = m2[2][i] - m2[6][i]; m3[7][i] = m2[3][i] - m2[7][i]; m1[0][i] = m3[0][i] + m3[2][i]; m1[1][i] = m3[1][i] + m3[3][i]; m1[2][i] = m3[0][i] - m3[2][i]; m1[3][i] = m3[1][i] - m3[3][i]; m1[4][i] = m3[4][i] + m3[6][i]; m1[5][i] = m3[5][i] + m3[7][i]; m1[6][i] = m3[4][i] - m3[6][i]; m1[7][i] = m3[5][i] - m3[7][i]; m2[0][i] = m1[0][i] + m1[1][i]; m2[1][i] = m1[0][i] - m1[1][i]; m2[2][i] = m1[2][i] + m1[3][i]; m2[3][i] = m1[2][i] - m1[3][i]; m2[4][i] = m1[4][i] + m1[5][i]; m2[5][i] = m1[4][i] - m1[5][i]; m2[6][i] = m1[6][i] + m1[7][i]; m2[7][i] = m1[6][i] - m1[7][i]; } for (i = 0; i < 8; i++) { for (j = 0; j < 8; j++) { sad += abs(m2[i][j]); } } sad=((sad+2)>>2); return sad; } #if NS_HAD UInt TComRdCost::xCalcHADs16x4( Pel *piOrg, Pel *piCur, Int iStrideOrg, Int iStrideCur, Int iStep ) { Int k, i, j, jj, sad=0; Int diff[64], m1[4][16], m2[4][16]; assert( iStep == 1 ); for( k = 0; k < 64; k += 16 ) { diff[k+0] = piOrg[0] - piCur[0]; diff[k+1] = piOrg[1] - piCur[1]; diff[k+2] = piOrg[2] - piCur[2]; diff[k+3] = piOrg[3] - piCur[3]; diff[k+4] = piOrg[4] - piCur[4]; diff[k+5] = piOrg[5] - piCur[5]; diff[k+6] = piOrg[6] - piCur[6]; diff[k+7] = piOrg[7] - piCur[7]; diff[k+8] = piOrg[8] - piCur[8] ; diff[k+9] = piOrg[9] - piCur[9] ; diff[k+10] = piOrg[10] - piCur[10]; diff[k+11] = piOrg[11] - piCur[11]; diff[k+12] = piOrg[12] - piCur[12]; diff[k+13] = piOrg[13] - piCur[13]; diff[k+14] = piOrg[14] - piCur[14]; diff[k+15] = piOrg[15] - piCur[15]; piCur += iStrideCur; piOrg += iStrideOrg; } //horizontal for (j=0; j < 4; j++) { jj = j << 4; m2[j][0] = diff[jj ] + diff[jj+8]; m2[j][1] = diff[jj+1] + diff[jj+9]; m2[j][2] = diff[jj+2] + diff[jj+10]; m2[j][3] = diff[jj+3] + diff[jj+11]; m2[j][4] = diff[jj+4] + diff[jj+12]; m2[j][5] = diff[jj+5] + diff[jj+13]; m2[j][6] = diff[jj+6] + diff[jj+14]; m2[j][7] = diff[jj+7] + diff[jj+15]; m2[j][8] = diff[jj ] - diff[jj+8]; m2[j][9] = diff[jj+1] - diff[jj+9]; m2[j][10] = diff[jj+2] - diff[jj+10]; m2[j][11] = diff[jj+3] - diff[jj+11]; m2[j][12] = diff[jj+4] - diff[jj+12]; m2[j][13] = diff[jj+5] - diff[jj+13]; m2[j][14] = diff[jj+6] - diff[jj+14]; m2[j][15] = diff[jj+7] - diff[jj+15]; m1[j][0] = m2[j][0] + m2[j][4]; m1[j][1] = m2[j][1] + m2[j][5]; m1[j][2] = m2[j][2] + m2[j][6]; m1[j][3] = m2[j][3] + m2[j][7]; m1[j][4] = m2[j][0] - m2[j][4]; m1[j][5] = m2[j][1] - m2[j][5]; m1[j][6] = m2[j][2] - m2[j][6]; m1[j][7] = m2[j][3] - m2[j][7]; m1[j][8] = m2[j][8] + m2[j][12]; m1[j][9] = m2[j][9] + m2[j][13]; m1[j][10] = m2[j][10] + m2[j][14]; m1[j][11] = m2[j][11] + m2[j][15]; m1[j][12] = m2[j][8] - m2[j][12]; m1[j][13] = m2[j][9] - m2[j][13]; m1[j][14] = m2[j][10] - m2[j][14]; m1[j][15] = m2[j][11] - m2[j][15]; m2[j][0] = m1[j][0] + m1[j][2]; m2[j][1] = m1[j][1] + m1[j][3]; m2[j][2] = m1[j][0] - m1[j][2]; m2[j][3] = m1[j][1] - m1[j][3]; m2[j][4] = m1[j][4] + m1[j][6]; m2[j][5] = m1[j][5] + m1[j][7]; m2[j][6] = m1[j][4] - m1[j][6]; m2[j][7] = m1[j][5] - m1[j][7]; m2[j][8] = m1[j][8] + m1[j][10]; m2[j][9] = m1[j][9] + m1[j][11]; m2[j][10] = m1[j][8] - m1[j][10]; m2[j][11] = m1[j][9] - m1[j][11]; m2[j][12] = m1[j][12] + m1[j][14]; m2[j][13] = m1[j][13] + m1[j][15]; m2[j][14] = m1[j][12] - m1[j][14]; m2[j][15] = m1[j][13] - m1[j][15]; m1[j][0] = m2[j][0] + m2[j][1]; m1[j][1] = m2[j][0] - m2[j][1]; m1[j][2] = m2[j][2] + m2[j][3]; m1[j][3] = m2[j][2] - m2[j][3]; m1[j][4] = m2[j][4] + m2[j][5]; m1[j][5] = m2[j][4] - m2[j][5]; m1[j][6] = m2[j][6] + m2[j][7]; m1[j][7] = m2[j][6] - m2[j][7]; m1[j][8] = m2[j][8] + m2[j][9]; m1[j][9] = m2[j][8] - m2[j][9]; m1[j][10] = m2[j][10] + m2[j][11]; m1[j][11] = m2[j][10] - m2[j][11]; m1[j][12] = m2[j][12] + m2[j][13]; m1[j][13] = m2[j][12] - m2[j][13]; m1[j][14] = m2[j][14] + m2[j][15]; m1[j][15] = m2[j][14] - m2[j][15]; } //vertical for (i=0; i < 16; i++) { m2[0][i] = m1[0][i] + m1[2][i]; m2[1][i] = m1[1][i] + m1[3][i]; m2[2][i] = m1[0][i] - m1[2][i]; m2[3][i] = m1[1][i] - m1[3][i]; m1[0][i] = m2[0][i] + m2[1][i]; m1[1][i] = m2[0][i] - m2[1][i]; m1[2][i] = m2[2][i] + m2[3][i]; m1[3][i] = m2[2][i] - m2[3][i]; } for (i = 0; i < 4; i++) { for (j = 0; j < 16; j++) { sad += abs(m1[i][j]); } } sad=((sad+2)>>2); return sad; } UInt TComRdCost::xCalcHADs4x16( Pel *piOrg, Pel *piCur, Int iStrideOrg, Int iStrideCur, Int iStep ) { Int k, i, j, jj, sad=0; Int diff[64], m1[16][4], m2[16][4], m3[16][4]; assert( iStep == 1 ); for( k = 0; k < 64; k += 4 ) { diff[k+0] = piOrg[0] - piCur[0]; diff[k+1] = piOrg[1] - piCur[1]; diff[k+2] = piOrg[2] - piCur[2]; diff[k+3] = piOrg[3] - piCur[3]; piCur += iStrideCur; piOrg += iStrideOrg; } //horizontal for (j=0; j < 16; j++) { jj = j << 2; m2[j][0] = diff[jj ] + diff[jj+2]; m2[j][1] = diff[jj+1] + diff[jj+3]; m2[j][2] = diff[jj ] - diff[jj+2]; m2[j][3] = diff[jj+1] - diff[jj+3]; m1[j][0] = m2[j][0] + m2[j][1]; m1[j][1] = m2[j][0] - m2[j][1]; m1[j][2] = m2[j][2] + m2[j][3]; m1[j][3] = m2[j][2] - m2[j][3]; } //vertical for (i=0; i < 4; i++) { m2[0][i] = m1[0][i] + m1[8][i]; m2[1][i] = m1[1][i] + m1[9][i]; m2[2][i] = m1[2][i] + m1[10][i]; m2[3][i] = m1[3][i] + m1[11][i]; m2[4][i] = m1[4][i] + m1[12][i]; m2[5][i] = m1[5][i] + m1[13][i]; m2[6][i] = m1[6][i] + m1[14][i]; m2[7][i] = m1[7][i] + m1[15][i]; m2[8][i] = m1[0][i] - m1[8][i]; m2[9][i] = m1[1][i] - m1[9][i]; m2[10][i] = m1[2][i] - m1[10][i]; m2[11][i] = m1[3][i] - m1[11][i]; m2[12][i] = m1[4][i] - m1[12][i]; m2[13][i] = m1[5][i] - m1[13][i]; m2[14][i] = m1[6][i] - m1[14][i]; m2[15][i] = m1[7][i] - m1[15][i]; m3[0][i] = m2[0][i] + m2[4][i]; m3[1][i] = m2[1][i] + m2[5][i]; m3[2][i] = m2[2][i] + m2[6][i]; m3[3][i] = m2[3][i] + m2[7][i]; m3[4][i] = m2[0][i] - m2[4][i]; m3[5][i] = m2[1][i] - m2[5][i]; m3[6][i] = m2[2][i] - m2[6][i]; m3[7][i] = m2[3][i] - m2[7][i]; m3[8][i] = m2[8][i] + m2[12][i]; m3[9][i] = m2[9][i] + m2[13][i]; m3[10][i] = m2[10][i] + m2[14][i]; m3[11][i] = m2[11][i] + m2[15][i]; m3[12][i] = m2[8][i] - m2[12][i]; m3[13][i] = m2[9][i] - m2[13][i]; m3[14][i] = m2[10][i] - m2[14][i]; m3[15][i] = m2[11][i] - m2[15][i]; m1[0][i] = m3[0][i] + m3[2][i]; m1[1][i] = m3[1][i] + m3[3][i]; m1[2][i] = m3[0][i] - m3[2][i]; m1[3][i] = m3[1][i] - m3[3][i]; m1[4][i] = m3[4][i] + m3[6][i]; m1[5][i] = m3[5][i] + m3[7][i]; m1[6][i] = m3[4][i] - m3[6][i]; m1[7][i] = m3[5][i] - m3[7][i]; m1[8][i] = m3[8][i] + m3[10][i]; m1[9][i] = m3[9][i] + m3[11][i]; m1[10][i] = m3[8][i] - m3[10][i]; m1[11][i] = m3[9][i] - m3[11][i]; m1[12][i] = m3[12][i] + m3[14][i]; m1[13][i] = m3[13][i] + m3[15][i]; m1[14][i] = m3[12][i] - m3[14][i]; m1[15][i] = m3[13][i] - m3[15][i]; m2[0][i] = m1[0][i] + m1[1][i]; m2[1][i] = m1[0][i] - m1[1][i]; m2[2][i] = m1[2][i] + m1[3][i]; m2[3][i] = m1[2][i] - m1[3][i]; m2[4][i] = m1[4][i] + m1[5][i]; m2[5][i] = m1[4][i] - m1[5][i]; m2[6][i] = m1[6][i] + m1[7][i]; m2[7][i] = m1[6][i] - m1[7][i]; m2[8][i] = m1[8][i] + m1[9][i]; m2[9][i] = m1[8][i] - m1[9][i]; m2[10][i] = m1[10][i] + m1[11][i]; m2[11][i] = m1[10][i] - m1[11][i]; m2[12][i] = m1[12][i] + m1[13][i]; m2[13][i] = m1[12][i] - m1[13][i]; m2[14][i] = m1[14][i] + m1[15][i]; m2[15][i] = m1[14][i] - m1[15][i]; } for (i = 0; i < 16; i++) { for (j = 0; j < 4; j++) { sad += abs(m2[i][j]); } } sad=((sad+2)>>2); return sad; } #endif UInt TComRdCost::xGetHADs4( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetHADs4w( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStep = pcDtParam->iStep; Int y; Int iOffsetOrg = iStrideOrg<<2; Int iOffsetCur = iStrideCur<<2; UInt uiSum = 0; for ( y=0; y> g_uiBitIncrement ); } UInt TComRdCost::xGetHADs8( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetHADs8w( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStep = pcDtParam->iStep; Int y; UInt uiSum = 0; if ( iRows == 4 ) { uiSum += xCalcHADs4x4( piOrg+0, piCur , iStrideOrg, iStrideCur, iStep ); uiSum += xCalcHADs4x4( piOrg+4, piCur+4*iStep, iStrideOrg, iStrideCur, iStep ); } else { Int iOffsetOrg = iStrideOrg<<3; Int iOffsetCur = iStrideCur<<3; for ( y=0; y> g_uiBitIncrement ); } UInt TComRdCost::xGetHADs( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetHADsw( pcDtParam ); } #if LGE_ILLUCOMP_B0045 if(pcDtParam->bUseIC) { return xGetHADsic( pcDtParam ); } #endif Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStep = pcDtParam->iStep; Int x, y; UInt uiSum = 0; #if NS_HAD if( ( ( iRows % 8 == 0) && (iCols % 8 == 0) && ( iRows == iCols ) ) || ( ( iRows % 8 == 0 ) && (iCols % 8 == 0) && !pcDtParam->bUseNSHAD ) ) #else if( ( iRows % 8 == 0) && (iCols % 8 == 0) ) #endif { Int iOffsetOrg = iStrideOrg<<3; Int iOffsetCur = iStrideCur<<3; for ( y=0; y 8 ) && ( iCols > iRows ) && pcDtParam->bUseNSHAD ) { Int iOffsetOrg = iStrideOrg<<2; Int iOffsetCur = iStrideCur<<2; for ( y=0; y 8 ) && ( iCols < iRows ) && pcDtParam->bUseNSHAD ) { Int iOffsetOrg = iStrideOrg<<4; Int iOffsetCur = iStrideCur<<4; for ( y=0; y> g_uiBitIncrement ); } #if LGE_ILLUCOMP_B0045 UInt TComRdCost::xGetHADsic( DistParam* pcDtParam ) { if ( pcDtParam->bApplyWeight ) { return xGetHADsw( pcDtParam ); } Pel* piOrg = pcDtParam->pOrg; Pel* piCur = pcDtParam->pCur; Int iRows = pcDtParam->iRows; Int iCols = pcDtParam->iCols; Int iStrideCur = pcDtParam->iStrideCur; Int iStrideOrg = pcDtParam->iStrideOrg; Int iStep = pcDtParam->iStep; Int x, y; UInt uiSum = 0; Int iOrigAvg = 0, iCurAvg = 0; Int iDeltaC; for ( y=0; ypOrg; piCur = pcDtParam->pCur; iDeltaC = (iOrigAvg - iCurAvg)/iRows/iCols; for ( y=0; ypOrg; #if NS_HAD if( ( ( iRows % 8 == 0) && (iCols % 8 == 0) && ( iRows == iCols ) ) || ( ( iRows % 8 == 0 ) && (iCols % 8 == 0) && !pcDtParam->bUseNSHAD ) ) #else if( ( iRows % 8 == 0) && (iCols % 8 == 0) ) #endif { Int iOffsetOrg = iStrideOrg<<3; Int iOffsetCur = iStrideCur<<3; for ( y=0; y 8 ) && ( iCols > iRows ) && pcDtParam->bUseNSHAD ) { Int iOffsetOrg = iStrideOrg<<2; Int iOffsetCur = iStrideCur<<2; for ( y=0; y 8 ) && ( iCols < iRows ) && pcDtParam->bUseNSHAD ) { Int iOffsetOrg = iStrideOrg<<4; Int iOffsetCur = iStrideCur<<4; for ( y=0; ypOrg; for ( y=0; y> g_uiBitIncrement ); } #endif #if HHI_VSO Void TComRdCost::setLambdaVSO( Double dLambdaVSO ) { m_dLambdaVSO = dLambdaVSO; m_dSqrtLambdaVSO = sqrt(m_dLambdaVSO); m_uiLambdaMotionSADVSO = (UInt)floor(65536.0 * m_dSqrtLambdaVSO); m_uiLambdaMotionSSEVSO = (UInt)floor(65536.0 * m_dLambdaVSO ); } Dist TComRdCost::xGetDistVSOMode4( Int iStartPosX, Int iStartPosY, Pel* piCur, Int iCurStride, Pel* piOrg, Int iOrgStride, UInt uiBlkWidth, UInt uiBlkHeight, Bool bSAD ) { AOT(bSAD); #ifdef LGE_VSO_EARLY_SKIP_A0093 RMDist iDist = m_pcRenModel->getDist( iStartPosX, iStartPosY, (Int) uiBlkWidth, (Int) uiBlkHeight, iCurStride, piCur, piOrg, iOrgStride); #else RMDist iDist = m_pcRenModel->getDist( iStartPosX, iStartPosY, (Int) uiBlkWidth, (Int) uiBlkHeight, iCurStride, piCur ); #endif RMDist iDistMin = (RMDist) RDO_DIST_MIN; #if HHI_VSO_DIST_INT iDistMin = m_bAllowNegDist ? RDO_DIST_MIN : 0; #endif iDist = Min( iDist, (RMDist) RDO_DIST_MAX); iDist = Max( iDist, iDistMin); return (Dist) iDist; } Dist TComRdCost::getDistVS( TComDataCU* pcCU, UInt uiAbsPartIndex, Pel* piCur, Int iCurStride, Pel* piOrg, Int iOrgStride, UInt uiBlkWidth, UInt uiBlkHeight, Bool bSAD, UInt uiPlane ) { assert( m_bUseVSO ); assert( this->m_fpDistortFuncVSO != 0 ); Int iPosX; Int iPosY; pcCU->getPosInPic( uiAbsPartIndex, iPosX, iPosY ); return (this->*m_fpDistortFuncVSO) ( iPosX, iPosY, piCur, iCurStride, piOrg, iOrgStride, uiBlkWidth, uiBlkHeight, bSAD ); }; Void TComRdCost::setVSOMode( UInt uiIn ) { m_uiVSOMode = uiIn; switch (m_uiVSOMode ) { case 4: m_fpDistortFuncVSO = &TComRdCost::xGetDistVSOMode4; break; default: assert(0); break; } } Double TComRdCost::calcRdCostVSO( UInt uiBits, Dist uiDistortion, Bool bFlag, DFunc eDFunc ) { assert( m_bUseLambdaScaleVSO ); Double dRdCost = 0.0; Double dLambda = 0.0; switch ( eDFunc ) { case DF_SSE: assert(0); break; case DF_SAD: dLambda = (Double)m_uiLambdaMotionSADVSO; break; case DF_DEFAULT: dLambda = m_dLambdaVSO; break; case DF_SSE_FRAME: dLambda = m_dFrameLambdaVSO; break; default: assert (0); break; } if (bFlag) { // Intra8x8, Intra4x4 Block only... dRdCost = (((Double)uiDistortion) + ((Double)uiBits * dLambda)); } else { if (eDFunc == DF_SAD) { dRdCost = ((Double)uiDistortion + (Double)((Int)(uiBits * dLambda+.5)>>16)); dRdCost = (Double)(Dist)floor(dRdCost); } else { dRdCost = ((Double)uiDistortion + (Double)((Int)(uiBits * dLambda+.5))); dRdCost = (Double)(Dist)floor(dRdCost); } } return dRdCost; } Void TComRdCost::setRenModelData( TComDataCU* pcCU, UInt uiAbsPartIndex, Pel* piData, Int iStride, Int iBlkWidth, Int iBlkHeight ) { UInt iBlkX = g_auiRasterToPelX[g_auiZscanToRaster[uiAbsPartIndex]]; UInt iBlkY = g_auiRasterToPelY[g_auiZscanToRaster[uiAbsPartIndex]]; Int iStartPosX = iBlkX + pcCU->getCUPelX(); Int iStartPosY = iBlkY + pcCU->getCUPelY(); m_pcRenModel->setData( iStartPosX, iStartPosY, iBlkWidth, iBlkHeight, iStride, piData ); } #if HHI_VSO_DIST_INT Void TComRdCost::setAllowNegDist( Bool bAllowNegDist ) { m_bAllowNegDist = bAllowNegDist; } #endif #endif //! \}