178e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar/*
278e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar * Copyright (C) 2007-2008 ARM Limited
378e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar *
478e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar * Licensed under the Apache License, Version 2.0 (the "License");
578e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar * you may not use this file except in compliance with the License.
678e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar * You may obtain a copy of the License at
778e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar *
878e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar *      http://www.apache.org/licenses/LICENSE-2.0
978e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar *
1078e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar * Unless required by applicable law or agreed to in writing, software
1178e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar * distributed under the License is distributed on an "AS IS" BASIS,
1278e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
1378e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar * See the License for the specific language governing permissions and
1478e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar * limitations under the License.
1578e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar *
1678e52bfac041d71ce53b5b13c2abf78af742b09dLajos Molnar */
170c1bc742181ded4930842b46e9507372f0b1b963James Dong/**
180c1bc742181ded4930842b46e9507372f0b1b963James Dong *
190c1bc742181ded4930842b46e9507372f0b1b963James Dong * File Name:  omxVCM4P10_TransformQuant_LumaDC.c
200c1bc742181ded4930842b46e9507372f0b1b963James Dong * OpenMAX DL: v1.0.2
210c1bc742181ded4930842b46e9507372f0b1b963James Dong * Revision:   9641
220c1bc742181ded4930842b46e9507372f0b1b963James Dong * Date:       Thursday, February 7, 2008
230c1bc742181ded4930842b46e9507372f0b1b963James Dong *
240c1bc742181ded4930842b46e9507372f0b1b963James Dong *
250c1bc742181ded4930842b46e9507372f0b1b963James Dong *
260c1bc742181ded4930842b46e9507372f0b1b963James Dong * Description:
270c1bc742181ded4930842b46e9507372f0b1b963James Dong * This function will calculate 4x4 hadamard transform of luma DC coefficients
280c1bc742181ded4930842b46e9507372f0b1b963James Dong * and quantization
290c1bc742181ded4930842b46e9507372f0b1b963James Dong *
300c1bc742181ded4930842b46e9507372f0b1b963James Dong */
310c1bc742181ded4930842b46e9507372f0b1b963James Dong
320c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "omxtypes.h"
330c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "armOMX.h"
340c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "omxVC.h"
350c1bc742181ded4930842b46e9507372f0b1b963James Dong
360c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "armCOMM.h"
370c1bc742181ded4930842b46e9507372f0b1b963James Dong#include "armVC.h"
380c1bc742181ded4930842b46e9507372f0b1b963James Dong
390c1bc742181ded4930842b46e9507372f0b1b963James Dong/**
400c1bc742181ded4930842b46e9507372f0b1b963James Dong * Function:  omxVCM4P10_TransformQuant_LumaDC   (6.3.5.6.2)
410c1bc742181ded4930842b46e9507372f0b1b963James Dong *
420c1bc742181ded4930842b46e9507372f0b1b963James Dong * Description:
430c1bc742181ded4930842b46e9507372f0b1b963James Dong * This function performs a 4x4 Hadamard transform of luma DC coefficients
440c1bc742181ded4930842b46e9507372f0b1b963James Dong * and then quantizes the coefficients.
450c1bc742181ded4930842b46e9507372f0b1b963James Dong *
460c1bc742181ded4930842b46e9507372f0b1b963James Dong * Input Arguments:
470c1bc742181ded4930842b46e9507372f0b1b963James Dong *
480c1bc742181ded4930842b46e9507372f0b1b963James Dong *   pSrcDst - Pointer to the 4x4 array of luma DC coefficients.  16-byte
490c1bc742181ded4930842b46e9507372f0b1b963James Dong *            alignment required.
500c1bc742181ded4930842b46e9507372f0b1b963James Dong *   iQP - Quantization parameter; must be in the range [0,51].
510c1bc742181ded4930842b46e9507372f0b1b963James Dong *
520c1bc742181ded4930842b46e9507372f0b1b963James Dong * Output Arguments:
530c1bc742181ded4930842b46e9507372f0b1b963James Dong *
540c1bc742181ded4930842b46e9507372f0b1b963James Dong *   pSrcDst - Pointer to transformed and quantized coefficients.  16-byte
550c1bc742181ded4930842b46e9507372f0b1b963James Dong *             alignment required.
560c1bc742181ded4930842b46e9507372f0b1b963James Dong *
570c1bc742181ded4930842b46e9507372f0b1b963James Dong * Return Value:
580c1bc742181ded4930842b46e9507372f0b1b963James Dong *
590c1bc742181ded4930842b46e9507372f0b1b963James Dong *    OMX_Sts_NoErr - no error
600c1bc742181ded4930842b46e9507372f0b1b963James Dong *    OMX_Sts_BadArgErr - bad arguments; returned if any of the following
610c1bc742181ded4930842b46e9507372f0b1b963James Dong *              conditions are true:
620c1bc742181ded4930842b46e9507372f0b1b963James Dong *    -    at least one of the following pointers is NULL: pSrcDst
630c1bc742181ded4930842b46e9507372f0b1b963James Dong *    -    pSrcDst is not aligned on an 16-byte boundary
640c1bc742181ded4930842b46e9507372f0b1b963James Dong *
650c1bc742181ded4930842b46e9507372f0b1b963James Dong */
660c1bc742181ded4930842b46e9507372f0b1b963James DongOMXResult omxVCM4P10_TransformQuant_LumaDC(
670c1bc742181ded4930842b46e9507372f0b1b963James Dong	OMX_S16* 	pSrcDst,
680c1bc742181ded4930842b46e9507372f0b1b963James Dong	OMX_U32		iQP
690c1bc742181ded4930842b46e9507372f0b1b963James Dong)
700c1bc742181ded4930842b46e9507372f0b1b963James Dong{
710c1bc742181ded4930842b46e9507372f0b1b963James Dong    OMX_INT     i, j;
720c1bc742181ded4930842b46e9507372f0b1b963James Dong    OMX_S32     m1[4][4], m2[4][4];
730c1bc742181ded4930842b46e9507372f0b1b963James Dong    OMX_S32     Value;
740c1bc742181ded4930842b46e9507372f0b1b963James Dong    OMX_U32     QbitsPlusOne, Two_f, MF;
750c1bc742181ded4930842b46e9507372f0b1b963James Dong
760c1bc742181ded4930842b46e9507372f0b1b963James Dong    /* Check for argument error */
770c1bc742181ded4930842b46e9507372f0b1b963James Dong    armRetArgErrIf(pSrcDst == NULL, OMX_Sts_BadArgErr);
780c1bc742181ded4930842b46e9507372f0b1b963James Dong    armRetArgErrIf(armNot16ByteAligned(pSrcDst), OMX_Sts_BadArgErr);
790c1bc742181ded4930842b46e9507372f0b1b963James Dong    armRetArgErrIf(iQP > 51, OMX_Sts_BadArgErr);
800c1bc742181ded4930842b46e9507372f0b1b963James Dong
810c1bc742181ded4930842b46e9507372f0b1b963James Dong    /* Hadamard Transform for 4x4 block */
820c1bc742181ded4930842b46e9507372f0b1b963James Dong    /* Horizontal Hadamard */
830c1bc742181ded4930842b46e9507372f0b1b963James Dong    for (i = 0; i < 4; i++)
840c1bc742181ded4930842b46e9507372f0b1b963James Dong    {
850c1bc742181ded4930842b46e9507372f0b1b963James Dong        j = i * 4;
860c1bc742181ded4930842b46e9507372f0b1b963James Dong
870c1bc742181ded4930842b46e9507372f0b1b963James Dong        m1[i][0] = pSrcDst[j + 0] + pSrcDst[j + 2]; /* a+c */
880c1bc742181ded4930842b46e9507372f0b1b963James Dong        m1[i][1] = pSrcDst[j + 1] + pSrcDst[j + 3]; /* b+d */
890c1bc742181ded4930842b46e9507372f0b1b963James Dong        m1[i][2] = pSrcDst[j + 0] - pSrcDst[j + 2]; /* a-c */
900c1bc742181ded4930842b46e9507372f0b1b963James Dong        m1[i][3] = pSrcDst[j + 1] - pSrcDst[j + 3]; /* b-d */
910c1bc742181ded4930842b46e9507372f0b1b963James Dong
920c1bc742181ded4930842b46e9507372f0b1b963James Dong        m2[i][0] = m1[i][0] + m1[i][1]; /* a+b+c+d */
930c1bc742181ded4930842b46e9507372f0b1b963James Dong        m2[i][1] = m1[i][2] + m1[i][3]; /* a+b-c-d */
940c1bc742181ded4930842b46e9507372f0b1b963James Dong        m2[i][2] = m1[i][2] - m1[i][3]; /* a-b-c+d */
950c1bc742181ded4930842b46e9507372f0b1b963James Dong        m2[i][3] = m1[i][0] - m1[i][1]; /* a-b+c-d */
960c1bc742181ded4930842b46e9507372f0b1b963James Dong
970c1bc742181ded4930842b46e9507372f0b1b963James Dong    }
980c1bc742181ded4930842b46e9507372f0b1b963James Dong
990c1bc742181ded4930842b46e9507372f0b1b963James Dong    /* Vertical */
1000c1bc742181ded4930842b46e9507372f0b1b963James Dong    for (i = 0; i < 4; i++)
1010c1bc742181ded4930842b46e9507372f0b1b963James Dong    {
1020c1bc742181ded4930842b46e9507372f0b1b963James Dong        m1[0][i] = m2[0][i] + m2[2][i];
1030c1bc742181ded4930842b46e9507372f0b1b963James Dong        m1[1][i] = m2[1][i] + m2[3][i];
1040c1bc742181ded4930842b46e9507372f0b1b963James Dong        m1[2][i] = m2[0][i] - m2[2][i];
1050c1bc742181ded4930842b46e9507372f0b1b963James Dong        m1[3][i] = m2[1][i] - m2[3][i];
1060c1bc742181ded4930842b46e9507372f0b1b963James Dong
1070c1bc742181ded4930842b46e9507372f0b1b963James Dong        m2[0][i] = m1[0][i] + m1[1][i];
1080c1bc742181ded4930842b46e9507372f0b1b963James Dong        m2[1][i] = m1[2][i] + m1[3][i];
1090c1bc742181ded4930842b46e9507372f0b1b963James Dong        m2[2][i] = m1[2][i] - m1[3][i];
1100c1bc742181ded4930842b46e9507372f0b1b963James Dong        m2[3][i] = m1[0][i] - m1[1][i];
1110c1bc742181ded4930842b46e9507372f0b1b963James Dong    }
1120c1bc742181ded4930842b46e9507372f0b1b963James Dong
1130c1bc742181ded4930842b46e9507372f0b1b963James Dong
1140c1bc742181ded4930842b46e9507372f0b1b963James Dong    /* Quantization */
1150c1bc742181ded4930842b46e9507372f0b1b963James Dong    QbitsPlusOne = ARM_M4P10_Q_OFFSET + 1 + (iQP / 6); /*floor (QP/6)*/
1160c1bc742181ded4930842b46e9507372f0b1b963James Dong    Two_f = (1 << QbitsPlusOne) / 3; /* 3->INTRA, 6->INTER */
1170c1bc742181ded4930842b46e9507372f0b1b963James Dong    MF = armVCM4P10_MFMatrix [iQP % 6][0];
1180c1bc742181ded4930842b46e9507372f0b1b963James Dong
1190c1bc742181ded4930842b46e9507372f0b1b963James Dong    /* Scaling */
1200c1bc742181ded4930842b46e9507372f0b1b963James Dong    for (j = 0; j < 4; j++)
1210c1bc742181ded4930842b46e9507372f0b1b963James Dong    {
1220c1bc742181ded4930842b46e9507372f0b1b963James Dong        for (i = 0; i < 4; i++)
1230c1bc742181ded4930842b46e9507372f0b1b963James Dong        {
1240c1bc742181ded4930842b46e9507372f0b1b963James Dong            Value = (armAbs((m2[j][i]/* + 1*/) / 2) * MF + Two_f) >> QbitsPlusOne;
1250c1bc742181ded4930842b46e9507372f0b1b963James Dong            pSrcDst[j * 4 + i] = (OMX_S16)((m2[j][i] < 0) ? -Value : Value);
1260c1bc742181ded4930842b46e9507372f0b1b963James Dong        }
1270c1bc742181ded4930842b46e9507372f0b1b963James Dong    }
1280c1bc742181ded4930842b46e9507372f0b1b963James Dong    return OMX_Sts_NoErr;
1290c1bc742181ded4930842b46e9507372f0b1b963James Dong}
1300c1bc742181ded4930842b46e9507372f0b1b963James Dong
1310c1bc742181ded4930842b46e9507372f0b1b963James Dong/*****************************************************************************
1320c1bc742181ded4930842b46e9507372f0b1b963James Dong *                              END OF FILE
1330c1bc742181ded4930842b46e9507372f0b1b963James Dong *****************************************************************************/
1340c1bc742181ded4930842b46e9507372f0b1b963James Dong
135