10c1bc742181ded4930842b46e9507372f0b1b963James Dong/** 20c1bc742181ded4930842b46e9507372f0b1b963James Dong * 30c1bc742181ded4930842b46e9507372f0b1b963James Dong * File Name: omxVCM4P10_TransformQuant_LumaDC.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 4x4 hadamard transform of luma DC coefficients 130c1bc742181ded4930842b46e9507372f0b1b963James Dong * and quantization 140c1bc742181ded4930842b46e9507372f0b1b963James Dong * 150c1bc742181ded4930842b46e9507372f0b1b963James Dong */ 160c1bc742181ded4930842b46e9507372f0b1b963James Dong 170c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "omxtypes.h" 180c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "armOMX.h" 190c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "omxVC.h" 200c1bc742181ded4930842b46e9507372f0b1b963James Dong 210c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "armCOMM.h" 220c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "armVC.h" 230c1bc742181ded4930842b46e9507372f0b1b963James Dong 240c1bc742181ded4930842b46e9507372f0b1b963James Dong/** 250c1bc742181ded4930842b46e9507372f0b1b963James Dong * Function: omxVCM4P10_TransformQuant_LumaDC (6.3.5.6.2) 260c1bc742181ded4930842b46e9507372f0b1b963James Dong * 270c1bc742181ded4930842b46e9507372f0b1b963James Dong * Description: 280c1bc742181ded4930842b46e9507372f0b1b963James Dong * This function performs a 4x4 Hadamard transform of luma DC coefficients 290c1bc742181ded4930842b46e9507372f0b1b963James Dong * and then quantizes the coefficients. 300c1bc742181ded4930842b46e9507372f0b1b963James Dong * 310c1bc742181ded4930842b46e9507372f0b1b963James Dong * Input Arguments: 320c1bc742181ded4930842b46e9507372f0b1b963James Dong * 330c1bc742181ded4930842b46e9507372f0b1b963James Dong * pSrcDst - Pointer to the 4x4 array of luma DC coefficients. 16-byte 340c1bc742181ded4930842b46e9507372f0b1b963James Dong * alignment required. 350c1bc742181ded4930842b46e9507372f0b1b963James Dong * iQP - Quantization parameter; must be in the range [0,51]. 360c1bc742181ded4930842b46e9507372f0b1b963James Dong * 370c1bc742181ded4930842b46e9507372f0b1b963James Dong * Output Arguments: 380c1bc742181ded4930842b46e9507372f0b1b963James Dong * 390c1bc742181ded4930842b46e9507372f0b1b963James Dong * pSrcDst - Pointer to transformed and quantized coefficients. 16-byte 400c1bc742181ded4930842b46e9507372f0b1b963James Dong * alignment required. 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: pSrcDst 480c1bc742181ded4930842b46e9507372f0b1b963James Dong * - pSrcDst is not aligned on an 16-byte boundary 490c1bc742181ded4930842b46e9507372f0b1b963James Dong * 500c1bc742181ded4930842b46e9507372f0b1b963James Dong */ 510c1bc742181ded4930842b46e9507372f0b1b963James DongOMXResult omxVCM4P10_TransformQuant_LumaDC( 520c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_S16* pSrcDst, 530c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_U32 iQP 540c1bc742181ded4930842b46e9507372f0b1b963James Dong) 550c1bc742181ded4930842b46e9507372f0b1b963James Dong{ 560c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_INT i, j; 570c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_S32 m1[4][4], m2[4][4]; 580c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_S32 Value; 590c1bc742181ded4930842b46e9507372f0b1b963James Dong OMX_U32 QbitsPlusOne, Two_f, MF; 600c1bc742181ded4930842b46e9507372f0b1b963James Dong 610c1bc742181ded4930842b46e9507372f0b1b963James Dong /* Check for argument error */ 620c1bc742181ded4930842b46e9507372f0b1b963James Dong armRetArgErrIf(pSrcDst == NULL, OMX_Sts_BadArgErr); 630c1bc742181ded4930842b46e9507372f0b1b963James Dong armRetArgErrIf(armNot16ByteAligned(pSrcDst), OMX_Sts_BadArgErr); 640c1bc742181ded4930842b46e9507372f0b1b963James Dong armRetArgErrIf(iQP > 51, OMX_Sts_BadArgErr); 650c1bc742181ded4930842b46e9507372f0b1b963James Dong 660c1bc742181ded4930842b46e9507372f0b1b963James Dong /* Hadamard Transform for 4x4 block */ 670c1bc742181ded4930842b46e9507372f0b1b963James Dong /* Horizontal Hadamard */ 680c1bc742181ded4930842b46e9507372f0b1b963James Dong for (i = 0; i < 4; i++) 690c1bc742181ded4930842b46e9507372f0b1b963James Dong { 700c1bc742181ded4930842b46e9507372f0b1b963James Dong j = i * 4; 710c1bc742181ded4930842b46e9507372f0b1b963James Dong 720c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[i][0] = pSrcDst[j + 0] + pSrcDst[j + 2]; /* a+c */ 730c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[i][1] = pSrcDst[j + 1] + pSrcDst[j + 3]; /* b+d */ 740c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[i][2] = pSrcDst[j + 0] - pSrcDst[j + 2]; /* a-c */ 750c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[i][3] = pSrcDst[j + 1] - pSrcDst[j + 3]; /* b-d */ 760c1bc742181ded4930842b46e9507372f0b1b963James Dong 770c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[i][0] = m1[i][0] + m1[i][1]; /* a+b+c+d */ 780c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[i][1] = m1[i][2] + m1[i][3]; /* a+b-c-d */ 790c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[i][2] = m1[i][2] - m1[i][3]; /* a-b-c+d */ 800c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[i][3] = m1[i][0] - m1[i][1]; /* a-b+c-d */ 810c1bc742181ded4930842b46e9507372f0b1b963James Dong 820c1bc742181ded4930842b46e9507372f0b1b963James Dong } 830c1bc742181ded4930842b46e9507372f0b1b963James Dong 840c1bc742181ded4930842b46e9507372f0b1b963James Dong /* Vertical */ 850c1bc742181ded4930842b46e9507372f0b1b963James Dong for (i = 0; i < 4; i++) 860c1bc742181ded4930842b46e9507372f0b1b963James Dong { 870c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[0][i] = m2[0][i] + m2[2][i]; 880c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[1][i] = m2[1][i] + m2[3][i]; 890c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[2][i] = m2[0][i] - m2[2][i]; 900c1bc742181ded4930842b46e9507372f0b1b963James Dong m1[3][i] = m2[1][i] - m2[3][i]; 910c1bc742181ded4930842b46e9507372f0b1b963James Dong 920c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[0][i] = m1[0][i] + m1[1][i]; 930c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[1][i] = m1[2][i] + m1[3][i]; 940c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[2][i] = m1[2][i] - m1[3][i]; 950c1bc742181ded4930842b46e9507372f0b1b963James Dong m2[3][i] = m1[0][i] - m1[1][i]; 960c1bc742181ded4930842b46e9507372f0b1b963James Dong } 970c1bc742181ded4930842b46e9507372f0b1b963James Dong 980c1bc742181ded4930842b46e9507372f0b1b963James Dong 990c1bc742181ded4930842b46e9507372f0b1b963James Dong /* Quantization */ 1000c1bc742181ded4930842b46e9507372f0b1b963James Dong QbitsPlusOne = ARM_M4P10_Q_OFFSET + 1 + (iQP / 6); /*floor (QP/6)*/ 1010c1bc742181ded4930842b46e9507372f0b1b963James Dong Two_f = (1 << QbitsPlusOne) / 3; /* 3->INTRA, 6->INTER */ 1020c1bc742181ded4930842b46e9507372f0b1b963James Dong MF = armVCM4P10_MFMatrix [iQP % 6][0]; 1030c1bc742181ded4930842b46e9507372f0b1b963James Dong 1040c1bc742181ded4930842b46e9507372f0b1b963James Dong /* Scaling */ 1050c1bc742181ded4930842b46e9507372f0b1b963James Dong for (j = 0; j < 4; j++) 1060c1bc742181ded4930842b46e9507372f0b1b963James Dong { 1070c1bc742181ded4930842b46e9507372f0b1b963James Dong for (i = 0; i < 4; i++) 1080c1bc742181ded4930842b46e9507372f0b1b963James Dong { 1090c1bc742181ded4930842b46e9507372f0b1b963James Dong Value = (armAbs((m2[j][i]/* + 1*/) / 2) * MF + Two_f) >> QbitsPlusOne; 1100c1bc742181ded4930842b46e9507372f0b1b963James Dong pSrcDst[j * 4 + i] = (OMX_S16)((m2[j][i] < 0) ? -Value : Value); 1110c1bc742181ded4930842b46e9507372f0b1b963James Dong } 1120c1bc742181ded4930842b46e9507372f0b1b963James Dong } 1130c1bc742181ded4930842b46e9507372f0b1b963James Dong return OMX_Sts_NoErr; 1140c1bc742181ded4930842b46e9507372f0b1b963James Dong} 1150c1bc742181ded4930842b46e9507372f0b1b963James Dong 1160c1bc742181ded4930842b46e9507372f0b1b963James Dong/***************************************************************************** 1170c1bc742181ded4930842b46e9507372f0b1b963James Dong * END OF FILE 1180c1bc742181ded4930842b46e9507372f0b1b963James Dong *****************************************************************************/ 1190c1bc742181ded4930842b46e9507372f0b1b963James Dong 120