10c1bc742181ded4930842b46e9507372f0b1b963James Dong/** 20c1bc742181ded4930842b46e9507372f0b1b963James Dong * 30c1bc742181ded4930842b46e9507372f0b1b963James Dong * File Name: omxVCM4P10_SATD_4x4.c 40c1bc742181ded4930842b46e9507372f0b1b963James Dong * OpenMAX DL: v1.0.2 50c1bc742181ded4930842b46e9507372f0b1b963James Dong * Revision: 9641 60c1bc742181ded4930842b46e9507372f0b1b963James Dong * Date: Thursday, February 7, 2008 70c1bc742181ded4930842b46e9507372f0b1b963James Dong * 80c1bc742181ded4930842b46e9507372f0b1b963James Dong * (c) Copyright 2007-2008 ARM Limited. All Rights Reserved. 90c1bc742181ded4930842b46e9507372f0b1b963James Dong * 100c1bc742181ded4930842b46e9507372f0b1b963James Dong * 110c1bc742181ded4930842b46e9507372f0b1b963James Dong * Description: 120c1bc742181ded4930842b46e9507372f0b1b963James Dong * This function will calculate SAD for 4x4 blocks 130c1bc742181ded4930842b46e9507372f0b1b963James Dong * 140c1bc742181ded4930842b46e9507372f0b1b963James Dong */ 150c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "omxtypes.h" 160c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "armOMX.h" 170c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "omxVC.h" 180c1bc742181ded4930842b46e9507372f0b1b963James Dong 190c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "armCOMM.h" 200c1bc742181ded4930842b46e9507372f0b1b963James Dong 210c1bc742181ded4930842b46e9507372f0b1b963James Dong/** 220c1bc742181ded4930842b46e9507372f0b1b963James Dong * Function: omxVCM4P10_SATD_4x4 (6.3.5.4.5) 230c1bc742181ded4930842b46e9507372f0b1b963James Dong * 240c1bc742181ded4930842b46e9507372f0b1b963James Dong * Description: 250c1bc742181ded4930842b46e9507372f0b1b963James Dong * This function calculates the sum of absolute transform differences (SATD) 260c1bc742181ded4930842b46e9507372f0b1b963James Dong * for a 4x4 block by applying a Hadamard transform to the difference block 270c1bc742181ded4930842b46e9507372f0b1b963James Dong * and then calculating the sum of absolute coefficient values. 280c1bc742181ded4930842b46e9507372f0b1b963James Dong * 290c1bc742181ded4930842b46e9507372f0b1b963James Dong * Input Arguments: 300c1bc742181ded4930842b46e9507372f0b1b963James Dong * 310c1bc742181ded4930842b46e9507372f0b1b963James Dong * pSrcOrg - Pointer to the original block; must be aligned on a 4-byte 320c1bc742181ded4930842b46e9507372f0b1b963James Dong * boundary 330c1bc742181ded4930842b46e9507372f0b1b963James Dong * iStepOrg - Step of the original block buffer; must be a multiple of 4 340c1bc742181ded4930842b46e9507372f0b1b963James Dong * pSrcRef - Pointer to the reference block; must be aligned on a 4-byte 350c1bc742181ded4930842b46e9507372f0b1b963James Dong * boundary 360c1bc742181ded4930842b46e9507372f0b1b963James Dong * iStepRef - Step of the reference block buffer; must be a multiple of 4 370c1bc742181ded4930842b46e9507372f0b1b963James Dong * 380c1bc742181ded4930842b46e9507372f0b1b963James Dong * Output Arguments: 390c1bc742181ded4930842b46e9507372f0b1b963James Dong * 400c1bc742181ded4930842b46e9507372f0b1b963James Dong * pDstSAD - pointer to the resulting SAD 410c1bc742181ded4930842b46e9507372f0b1b963James Dong * 420c1bc742181ded4930842b46e9507372f0b1b963James Dong * Return Value: 430c1bc742181ded4930842b46e9507372f0b1b963James Dong * 440c1bc742181ded4930842b46e9507372f0b1b963James Dong * OMX_Sts_NoErr - no error 450c1bc742181ded4930842b46e9507372f0b1b963James Dong * OMX_Sts_BadArgErr - bad arguments; returned if any of the following 460c1bc742181ded4930842b46e9507372f0b1b963James Dong * conditions are true: 470c1bc742181ded4930842b46e9507372f0b1b963James Dong * - at least one of the following pointers is NULL: 480c1bc742181ded4930842b46e9507372f0b1b963James Dong * pSrcOrg, pSrcRef, or pDstSAD either pSrcOrg 490c1bc742181ded4930842b46e9507372f0b1b963James Dong * - pSrcRef is not aligned on a 4-byte boundary 500c1bc742181ded4930842b46e9507372f0b1b963James Dong * - iStepOrg <= 0 or iStepOrg is not a multiple of 4 510c1bc742181ded4930842b46e9507372f0b1b963James Dong * - iStepRef <= 0 or iStepRef is not a multiple of 4 520c1bc742181ded4930842b46e9507372f0b1b963James Dong * 530c1bc742181ded4930842b46e9507372f0b1b963James Dong */ 540c1bc742181ded4930842b46e9507372f0b1b963James DongOMXResult omxVCM4P10_SATD_4x4( 550c1bc742181ded4930842b46e9507372f0b1b963James Dong const OMX_U8* pSrcOrg, 560c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_U32 iStepOrg, 570c1bc742181ded4930842b46e9507372f0b1b963James Dong const OMX_U8* pSrcRef, 580c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_U32 iStepRef, 590c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_U32* pDstSAD 600c1bc742181ded4930842b46e9507372f0b1b963James Dong) 610c1bc742181ded4930842b46e9507372f0b1b963James Dong{ 620c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_INT i, j; 630c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_S32 SATD = 0; 640c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_S32 d [4][4], m1[4][4], m2[4][4]; 650c1bc742181ded4930842b46e9507372f0b1b963James Dong 660c1bc742181ded4930842b46e9507372f0b1b963James Dong /* check for argument error */ 670c1bc742181ded4930842b46e9507372f0b1b963James Dong armRetArgErrIf(pSrcOrg == NULL, OMX_Sts_BadArgErr) 680c1bc742181ded4930842b46e9507372f0b1b963James Dong armRetArgErrIf(pSrcRef == NULL, OMX_Sts_BadArgErr) 690c1bc742181ded4930842b46e9507372f0b1b963James Dong armRetArgErrIf(pDstSAD == NULL, OMX_Sts_BadArgErr) 700c1bc742181ded4930842b46e9507372f0b1b963James Dong armRetArgErrIf((iStepOrg == 0) || (iStepOrg & 3), OMX_Sts_BadArgErr) 710c1bc742181ded4930842b46e9507372f0b1b963James Dong armRetArgErrIf((iStepRef == 0) || (iStepRef & 3), OMX_Sts_BadArgErr) 720c1bc742181ded4930842b46e9507372f0b1b963James Dong armRetArgErrIf(armNot4ByteAligned(pSrcOrg), OMX_Sts_BadArgErr) 730c1bc742181ded4930842b46e9507372f0b1b963James Dong armRetArgErrIf(armNot4ByteAligned(pSrcRef), OMX_Sts_BadArgErr) 740c1bc742181ded4930842b46e9507372f0b1b963James Dong 750c1bc742181ded4930842b46e9507372f0b1b963James Dong /* Calculate the difference */ 760c1bc742181ded4930842b46e9507372f0b1b963James Dong for (j = 0; j < 4; j++) 770c1bc742181ded4930842b46e9507372f0b1b963James Dong { 780c1bc742181ded4930842b46e9507372f0b1b963James Dong for (i = 0; i < 4; i++) 790c1bc742181ded4930842b46e9507372f0b1b963James Dong { 800c1bc742181ded4930842b46e9507372f0b1b963James Dong d [j][i] = pSrcOrg [j * iStepOrg + i] - pSrcRef [j * iStepRef + i]; 810c1bc742181ded4930842b46e9507372f0b1b963James Dong } 820c1bc742181ded4930842b46e9507372f0b1b963James Dong } 830c1bc742181ded4930842b46e9507372f0b1b963James Dong 840c1bc742181ded4930842b46e9507372f0b1b963James Dong /* Hadamard Transfor for 4x4 block */ 850c1bc742181ded4930842b46e9507372f0b1b963James Dong 860c1bc742181ded4930842b46e9507372f0b1b963James Dong /* Horizontal */ 870c1bc742181ded4930842b46e9507372f0b1b963James Dong for (i = 0; i < 4; i++) 880c1bc742181ded4930842b46e9507372f0b1b963James Dong { 890c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[i][0] = d[i][0] + d[i][2]; /* a+c */ 900c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[i][1] = d[i][1] + d[i][3]; /* b+d */ 910c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[i][2] = d[i][0] - d[i][2]; /* a-c */ 920c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[i][3] = d[i][1] - d[i][3]; /* b-d */ 930c1bc742181ded4930842b46e9507372f0b1b963James Dong 940c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[i][0] = m1[i][0] + m1[i][1]; /* a+b+c+d */ 950c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[i][1] = m1[i][2] + m1[i][3]; /* a+b-c-d */ 960c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[i][2] = m1[i][2] - m1[i][3]; /* a-b-c+d */ 970c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[i][3] = m1[i][0] - m1[i][1]; /* a-b+c-d */ 980c1bc742181ded4930842b46e9507372f0b1b963James Dong 990c1bc742181ded4930842b46e9507372f0b1b963James Dong } 1000c1bc742181ded4930842b46e9507372f0b1b963James Dong 1010c1bc742181ded4930842b46e9507372f0b1b963James Dong /* Vertical */ 1020c1bc742181ded4930842b46e9507372f0b1b963James Dong for (i = 0; i < 4; i++) 1030c1bc742181ded4930842b46e9507372f0b1b963James Dong { 1040c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[0][i] = m2[0][i] + m2[2][i]; 1050c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[1][i] = m2[1][i] + m2[3][i]; 1060c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[2][i] = m2[0][i] - m2[2][i]; 1070c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[3][i] = m2[1][i] - m2[3][i]; 1080c1bc742181ded4930842b46e9507372f0b1b963James Dong 1090c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[0][i] = m1[0][i] + m1[1][i]; 1100c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[1][i] = m1[2][i] + m1[3][i]; 1110c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[2][i] = m1[2][i] - m1[3][i]; 1120c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[3][i] = m1[0][i] - m1[1][i]; 1130c1bc742181ded4930842b46e9507372f0b1b963James Dong } 1140c1bc742181ded4930842b46e9507372f0b1b963James Dong 1150c1bc742181ded4930842b46e9507372f0b1b963James Dong /* calculate SAD for Transformed coefficients */ 1160c1bc742181ded4930842b46e9507372f0b1b963James Dong for (j = 0; j < 4; j++) 1170c1bc742181ded4930842b46e9507372f0b1b963James Dong { 1180c1bc742181ded4930842b46e9507372f0b1b963James Dong for (i = 0; i < 4; i++) 1190c1bc742181ded4930842b46e9507372f0b1b963James Dong { 1200c1bc742181ded4930842b46e9507372f0b1b963James Dong SATD += armAbs(m2 [j][i]); 1210c1bc742181ded4930842b46e9507372f0b1b963James Dong } 1220c1bc742181ded4930842b46e9507372f0b1b963James Dong } 1230c1bc742181ded4930842b46e9507372f0b1b963James Dong 1240c1bc742181ded4930842b46e9507372f0b1b963James Dong *pDstSAD = (SATD + 1) / 2; 1250c1bc742181ded4930842b46e9507372f0b1b963James Dong 1260c1bc742181ded4930842b46e9507372f0b1b963James Dong return OMX_Sts_NoErr; 1270c1bc742181ded4930842b46e9507372f0b1b963James Dong} 1280c1bc742181ded4930842b46e9507372f0b1b963James Dong 1290c1bc742181ded4930842b46e9507372f0b1b963James Dong/***************************************************************************** 1300c1bc742181ded4930842b46e9507372f0b1b963James Dong * END OF FILE 1310c1bc742181ded4930842b46e9507372f0b1b963James Dong *****************************************************************************/ 1320c1bc742181ded4930842b46e9507372f0b1b963James Dong 133