Home | History | Annotate | Download | only in src 
      1 /*
      2  * Copyright (C) 2007-2008 ARM Limited
      3  *
      4  * Licensed under the Apache License, Version 2.0 (the "License");
      5  * you may not use this file except in compliance with the License.
      6  * You may obtain a copy of the License at
      7  *
      8  *      http://www.apache.org/licenses/LICENSE-2.0
      9  *
     10  * Unless required by applicable law or agreed to in writing, software
     11  * distributed under the License is distributed on an "AS IS" BASIS,
     12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
     13  * See the License for the specific language governing permissions and
     14  * limitations under the License.
     15  *
     16  */
     17 /**
     18  *
     19  * File Name:  omxVCM4P10_SATD_4x4.c
     20  * OpenMAX DL: v1.0.2
     21  * Revision:   9641
     22  * Date:       Thursday, February 7, 2008
     23  *
     24  *
     25  *
     26  * Description:
     27  * This function will calculate SAD for 4x4 blocks
     28  *
     29  */
     30 #include "omxtypes.h"
     31 #include "armOMX.h"
     32 #include "omxVC.h"
     33 
     34 #include "armCOMM.h"
     35 
     36 /**
     37  * Function:  omxVCM4P10_SATD_4x4   (6.3.5.4.5)
     38  *
     39  * Description:
     40  * This function calculates the sum of absolute transform differences (SATD)
     41  * for a 4x4 block by applying a Hadamard transform to the difference block
     42  * and then calculating the sum of absolute coefficient values.
     43  *
     44  * Input Arguments:
     45  *
     46  *   pSrcOrg - Pointer to the original block; must be aligned on a 4-byte
     47  *            boundary
     48  *   iStepOrg - Step of the original block buffer; must be a multiple of 4
     49  *   pSrcRef - Pointer to the reference block; must be aligned on a 4-byte
     50  *            boundary
     51  *   iStepRef - Step of the reference block buffer; must be a multiple of 4
     52  *
     53  * Output Arguments:
     54  *
     55  *   pDstSAD - pointer to the resulting SAD
     56  *
     57  * Return Value:
     58  *
     59  *    OMX_Sts_NoErr - no error
     60  *    OMX_Sts_BadArgErr - bad arguments; returned if any of the following
     61  *              conditions are true:
     62  *    -    at least one of the following pointers is NULL:
     63  *         pSrcOrg, pSrcRef, or pDstSAD either pSrcOrg
     64  *    -    pSrcRef is not aligned on a 4-byte boundary
     65  *    -    iStepOrg <= 0 or iStepOrg is not a multiple of 4
     66  *    -    iStepRef <= 0 or iStepRef is not a multiple of 4
     67  *
     68  */
     69 OMXResult omxVCM4P10_SATD_4x4(
     70 	const OMX_U8*		pSrcOrg,
     71 	OMX_U32     iStepOrg,
     72 	const OMX_U8*		pSrcRef,
     73 	OMX_U32		iStepRef,
     74 	OMX_U32*    pDstSAD
     75 )
     76 {
     77     OMX_INT     i, j;
     78     OMX_S32     SATD = 0;
     79     OMX_S32     d [4][4], m1[4][4], m2[4][4];
     80 
     81     /* check for argument error */
     82     armRetArgErrIf(pSrcOrg == NULL, OMX_Sts_BadArgErr)
     83     armRetArgErrIf(pSrcRef == NULL, OMX_Sts_BadArgErr)
     84     armRetArgErrIf(pDstSAD == NULL, OMX_Sts_BadArgErr)
     85     armRetArgErrIf((iStepOrg == 0) || (iStepOrg & 3), OMX_Sts_BadArgErr)
     86     armRetArgErrIf((iStepRef == 0) || (iStepRef & 3), OMX_Sts_BadArgErr)
     87     armRetArgErrIf(armNot4ByteAligned(pSrcOrg), OMX_Sts_BadArgErr)
     88     armRetArgErrIf(armNot4ByteAligned(pSrcRef), OMX_Sts_BadArgErr)
     89 
     90     /* Calculate the difference */
     91     for (j = 0; j < 4; j++)
     92     {
     93         for (i = 0; i < 4; i++)
     94         {
     95             d [j][i] = pSrcOrg [j * iStepOrg + i] - pSrcRef [j * iStepRef + i];
     96         }
     97     }
     98 
     99     /* Hadamard Transfor for 4x4 block */
    100 
    101     /* Horizontal */
    102     for (i = 0; i < 4; i++)
    103     {
    104         m1[i][0] = d[i][0] + d[i][2]; /* a+c */
    105         m1[i][1] = d[i][1] + d[i][3]; /* b+d */
    106         m1[i][2] = d[i][0] - d[i][2]; /* a-c */
    107         m1[i][3] = d[i][1] - d[i][3]; /* b-d */
    108 
    109         m2[i][0] = m1[i][0] + m1[i][1]; /* a+b+c+d */
    110         m2[i][1] = m1[i][2] + m1[i][3]; /* a+b-c-d */
    111         m2[i][2] = m1[i][2] - m1[i][3]; /* a-b-c+d */
    112         m2[i][3] = m1[i][0] - m1[i][1]; /* a-b+c-d */
    113 
    114     }
    115 
    116     /* Vertical */
    117     for (i = 0; i < 4; i++)
    118     {
    119         m1[0][i] = m2[0][i] + m2[2][i];
    120         m1[1][i] = m2[1][i] + m2[3][i];
    121         m1[2][i] = m2[0][i] - m2[2][i];
    122         m1[3][i] = m2[1][i] - m2[3][i];
    123 
    124         m2[0][i] = m1[0][i] + m1[1][i];
    125         m2[1][i] = m1[2][i] + m1[3][i];
    126         m2[2][i] = m1[2][i] - m1[3][i];
    127         m2[3][i] = m1[0][i] - m1[1][i];
    128     }
    129 
    130     /* calculate SAD for Transformed coefficients */
    131     for (j = 0; j < 4; j++)
    132     {
    133         for (i = 0; i < 4; i++)
    134         {
    135             SATD += armAbs(m2 [j][i]);
    136         }
    137     }
    138 
    139     *pDstSAD = (SATD + 1) / 2;
    140 
    141     return OMX_Sts_NoErr;
    142 }
    143 
    144 /*****************************************************************************
    145  *                              END OF FILE
    146  *****************************************************************************/
    147 
    148