1/**
2 *
3 * File Name:  omxVCM4P10_TransformQuant_LumaDC.c
4 * OpenMAX DL: v1.0.2
5 * Revision:   9641
6 * Date:       Thursday, February 7, 2008
7 *
8 * (c) Copyright 2007-2008 ARM Limited. All Rights Reserved.
9 *
10 *
11 * Description:
12 * This function will calculate 4x4 hadamard transform of luma DC coefficients
13 * and quantization
14 *
15 */
16
17#include "omxtypes.h"
18#include "armOMX.h"
19#include "omxVC.h"
20
21#include "armCOMM.h"
22#include "armVC.h"
23
24/**
25 * Function:  omxVCM4P10_TransformQuant_LumaDC   (6.3.5.6.2)
26 *
27 * Description:
28 * This function performs a 4x4 Hadamard transform of luma DC coefficients
29 * and then quantizes the coefficients.
30 *
31 * Input Arguments:
32 *
33 *   pSrcDst - Pointer to the 4x4 array of luma DC coefficients.  16-byte
34 *            alignment required.
35 *   iQP - Quantization parameter; must be in the range [0,51].
36 *
37 * Output Arguments:
38 *
39 *   pSrcDst - Pointer to transformed and quantized coefficients.  16-byte
40 *             alignment required.
41 *
42 * Return Value:
43 *
44 *    OMX_Sts_NoErr - no error
45 *    OMX_Sts_BadArgErr - bad arguments; returned if any of the following
46 *              conditions are true:
47 *    -    at least one of the following pointers is NULL: pSrcDst
48 *    -    pSrcDst is not aligned on an 16-byte boundary
49 *
50 */
51OMXResult omxVCM4P10_TransformQuant_LumaDC(
52	OMX_S16* 	pSrcDst,
53	OMX_U32		iQP
54)
55{
56    OMX_INT     i, j;
57    OMX_S32     m1[4][4], m2[4][4];
58    OMX_S32     Value;
59    OMX_U32     QbitsPlusOne, Two_f, MF;
60
61    /* Check for argument error */
62    armRetArgErrIf(pSrcDst == NULL, OMX_Sts_BadArgErr);
63    armRetArgErrIf(armNot16ByteAligned(pSrcDst), OMX_Sts_BadArgErr);
64    armRetArgErrIf(iQP > 51, OMX_Sts_BadArgErr);
65
66    /* Hadamard Transform for 4x4 block */
67    /* Horizontal Hadamard */
68    for (i = 0; i < 4; i++)
69    {
70        j = i * 4;
71
72        m1[i][0] = pSrcDst[j + 0] + pSrcDst[j + 2]; /* a+c */
73        m1[i][1] = pSrcDst[j + 1] + pSrcDst[j + 3]; /* b+d */
74        m1[i][2] = pSrcDst[j + 0] - pSrcDst[j + 2]; /* a-c */
75        m1[i][3] = pSrcDst[j + 1] - pSrcDst[j + 3]; /* b-d */
76
77        m2[i][0] = m1[i][0] + m1[i][1]; /* a+b+c+d */
78        m2[i][1] = m1[i][2] + m1[i][3]; /* a+b-c-d */
79        m2[i][2] = m1[i][2] - m1[i][3]; /* a-b-c+d */
80        m2[i][3] = m1[i][0] - m1[i][1]; /* a-b+c-d */
81
82    }
83
84    /* Vertical */
85    for (i = 0; i < 4; i++)
86    {
87        m1[0][i] = m2[0][i] + m2[2][i];
88        m1[1][i] = m2[1][i] + m2[3][i];
89        m1[2][i] = m2[0][i] - m2[2][i];
90        m1[3][i] = m2[1][i] - m2[3][i];
91
92        m2[0][i] = m1[0][i] + m1[1][i];
93        m2[1][i] = m1[2][i] + m1[3][i];
94        m2[2][i] = m1[2][i] - m1[3][i];
95        m2[3][i] = m1[0][i] - m1[1][i];
96    }
97
98
99    /* Quantization */
100    QbitsPlusOne = ARM_M4P10_Q_OFFSET + 1 + (iQP / 6); /*floor (QP/6)*/
101    Two_f = (1 << QbitsPlusOne) / 3; /* 3->INTRA, 6->INTER */
102    MF = armVCM4P10_MFMatrix [iQP % 6][0];
103
104    /* Scaling */
105    for (j = 0; j < 4; j++)
106    {
107        for (i = 0; i < 4; i++)
108        {
109            Value = (armAbs((m2[j][i]/* + 1*/) / 2) * MF + Two_f) >> QbitsPlusOne;
110            pSrcDst[j * 4 + i] = (OMX_S16)((m2[j][i] < 0) ? -Value : Value);
111        }
112    }
113    return OMX_Sts_NoErr;
114}
115
116/*****************************************************************************
117 *                              END OF FILE
118 *****************************************************************************/
119
120