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