The-Homebrew-Cloud/Cemu
2
0
Fork 0
mirror of https://github.com/cemu-project/Cemu.git synced 2024-11-30 04:54:18 +01:00
Code Issues Packages Projects Releases Wiki Activity
35afb99c99
Cemu/dependencies/ih264d/common/x86/ih264_weighted_pred_sse42.c
Exzap d60742f52b Add all the files
2022-08-22 22:21:23 +02:00

1304 lines
62 KiB
C
Raw Blame History

/******************************************************************************
*
* Copyright (C) 2015 The Android Open Source Project
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at:
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*
*****************************************************************************
* Originally developed and contributed by Ittiam Systems Pvt. Ltd, Bangalore
*/
/*****************************************************************************/
/* */
/* File Name : ih264_weighted_pred_intr_sse42.c */
/* */
/* Description : Contains function definitions for weighted */
/* prediction functions in x86 sse4 intrinsics */
/* */
/* List of Functions : ih264_default_weighted_pred_luma_sse42() */
/* ih264_default_weighted_pred_chroma_sse42() */
/* ih264_weighted_pred_luma_sse42() */
/* ih264_weighted_pred_chroma_sse42() */
/* ih264_weighted_bipred_luma_sse42() */
/* ih264_weighted_bipred_chroma_sse42() */
/* */
/* Issues / Problems : None */
/* */
/* Revision History : */
/* */
/* DD MM YYYY Author(s) Changes */
/* 30 01 2015 Kaushik Initial version */
/* Senthoor */
/* */
/*****************************************************************************/
/*****************************************************************************/
/* File Includes */
/*****************************************************************************/
#include <immintrin.h>
#include "ih264_typedefs.h"
#include "ih264_macros.h"
#include "ih264_platform_macros.h"
#include "ih264_weighted_pred.h"
/*****************************************************************************/
/* Function definitions . */
/*****************************************************************************/
/*****************************************************************************/
/* */
/* Function Name : ih264_default_weighted_pred_luma_sse42 */
/* */
/* Description : This function performs the default weighted prediction */
/* as described in sec 8.4.2.3.1 titled "Default weighted */
/* sample prediction process" for luma. The function gets */
/* two ht x wd blocks, calculates their rounded-average and */
/* stores it in the destination block. (ht,wd) can be */
/* (4,4), (8,4), (4,8), (8,8), (16,8), (8,16) or (16,16). */
/* */
/* Inputs : pu1_src1 - Pointer to source 1 */
/* pu1_src2 - Pointer to source 2 */
/* pu1_dst - Pointer to destination */
/* src_strd1 - stride for source 1 */
/* src_strd1 - stride for source 2 */
/* dst_strd - stride for destination */
/* ht - height of the block */
/* wd - width of the block */
/* */
/* Issues : None */
/* */
/* Revision History: */
/* */
/* DD MM YYYY Author(s) Changes */
/* 04 02 2015 Kaushik Initial Version */
/* Senthoor */
/* */
/*****************************************************************************/
void ih264_default_weighted_pred_luma_sse42(UWORD8 *pu1_src1,
UWORD8 *pu1_src2,
UWORD8 *pu1_dst,
WORD32 src_strd1,
WORD32 src_strd2,
WORD32 dst_strd,
WORD32 ht,
WORD32 wd)
{
__m128i y0_0_16x8b, y0_1_16x8b, y0_2_16x8b, y0_3_16x8b;
__m128i y1_0_16x8b, y1_1_16x8b, y1_2_16x8b, y1_3_16x8b;
if(wd == 4)
{
do
{
y0_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src1);
y0_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1));
y0_2_16x8b = _mm_loadl_epi64(
(__m128i *)(pu1_src1 + (src_strd1 << 1)));
y0_3_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1 * 3));
y1_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src2);
y1_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2));
y1_2_16x8b = _mm_loadl_epi64(
(__m128i *)(pu1_src2 + (src_strd2 << 1)));
y1_3_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2 * 3));
y0_0_16x8b = _mm_avg_epu8(y0_0_16x8b, y1_0_16x8b);
y0_1_16x8b = _mm_avg_epu8(y0_1_16x8b, y1_1_16x8b);
y0_2_16x8b = _mm_avg_epu8(y0_2_16x8b, y1_2_16x8b);
y0_3_16x8b = _mm_avg_epu8(y0_3_16x8b, y1_3_16x8b);
*((WORD32 *)(pu1_dst)) = _mm_cvtsi128_si32(y0_0_16x8b);
*((WORD32 *)(pu1_dst + dst_strd)) = _mm_cvtsi128_si32(y0_1_16x8b);
*((WORD32 *)(pu1_dst + (dst_strd << 1))) = _mm_cvtsi128_si32(y0_2_16x8b);
*((WORD32 *)(pu1_dst + dst_strd * 3)) = _mm_cvtsi128_si32(y0_3_16x8b);
ht -= 4;
pu1_src1 += src_strd1 << 2;
pu1_src2 += src_strd2 << 2;
pu1_dst += dst_strd << 2;
}
while(ht > 0);
}
else if(wd == 8)
{
do
{
y0_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src1);
y0_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1));
y0_2_16x8b = _mm_loadl_epi64(
(__m128i *)(pu1_src1 + (src_strd1 << 1)));
y0_3_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1 * 3));
y1_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src2);
y1_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2));
y1_2_16x8b = _mm_loadl_epi64(
(__m128i *)(pu1_src2 + (src_strd2 << 1)));
y1_3_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2 * 3));
y0_0_16x8b = _mm_avg_epu8(y0_0_16x8b, y1_0_16x8b);
y0_1_16x8b = _mm_avg_epu8(y0_1_16x8b, y1_1_16x8b);
y0_2_16x8b = _mm_avg_epu8(y0_2_16x8b, y1_2_16x8b);
y0_3_16x8b = _mm_avg_epu8(y0_3_16x8b, y1_3_16x8b);
_mm_storel_epi64((__m128i *)pu1_dst, y0_0_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + dst_strd), y0_1_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + (dst_strd << 1)), y0_2_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + dst_strd * 3), y0_3_16x8b);
ht -= 4;
pu1_src1 += src_strd1 << 2;
pu1_src2 += src_strd2 << 2;
pu1_dst += dst_strd << 2;
}
while(ht > 0);
}
else // wd == 16
{
__m128i y0_4_16x8b, y0_5_16x8b, y0_6_16x8b, y0_7_16x8b;
__m128i y1_4_16x8b, y1_5_16x8b, y1_6_16x8b, y1_7_16x8b;
do
{
y0_0_16x8b = _mm_loadu_si128((__m128i *)pu1_src1);
y0_1_16x8b = _mm_loadu_si128((__m128i *)(pu1_src1 + src_strd1));
y0_2_16x8b = _mm_loadu_si128(
(__m128i *)(pu1_src1 + (src_strd1 << 1)));
y0_3_16x8b = _mm_loadu_si128((__m128i *)(pu1_src1 + src_strd1 * 3));
y0_4_16x8b = _mm_loadu_si128(
(__m128i *)(pu1_src1 + (src_strd1 << 2)));
y0_5_16x8b = _mm_loadu_si128((__m128i *)(pu1_src1 + src_strd1 * 5));
y0_6_16x8b = _mm_loadu_si128((__m128i *)(pu1_src1 + src_strd1 * 6));
y0_7_16x8b = _mm_loadu_si128((__m128i *)(pu1_src1 + src_strd1 * 7));
y1_0_16x8b = _mm_loadu_si128((__m128i *)pu1_src2);
y1_1_16x8b = _mm_loadu_si128((__m128i *)(pu1_src2 + src_strd2));
y1_2_16x8b = _mm_loadu_si128(
(__m128i *)(pu1_src2 + (src_strd2 << 1)));
y1_3_16x8b = _mm_loadu_si128((__m128i *)(pu1_src2 + src_strd2 * 3));
y1_4_16x8b = _mm_loadu_si128(
(__m128i *)(pu1_src2 + (src_strd2 << 2)));
y1_5_16x8b = _mm_loadu_si128((__m128i *)(pu1_src2 + src_strd2 * 5));
y1_6_16x8b = _mm_loadu_si128((__m128i *)(pu1_src2 + src_strd2 * 6));
y1_7_16x8b = _mm_loadu_si128((__m128i *)(pu1_src2 + src_strd2 * 7));
y0_0_16x8b = _mm_avg_epu8(y0_0_16x8b, y1_0_16x8b);
y0_1_16x8b = _mm_avg_epu8(y0_1_16x8b, y1_1_16x8b);
y0_2_16x8b = _mm_avg_epu8(y0_2_16x8b, y1_2_16x8b);
y0_3_16x8b = _mm_avg_epu8(y0_3_16x8b, y1_3_16x8b);
y0_4_16x8b = _mm_avg_epu8(y0_4_16x8b, y1_4_16x8b);
y0_5_16x8b = _mm_avg_epu8(y0_5_16x8b, y1_5_16x8b);
y0_6_16x8b = _mm_avg_epu8(y0_6_16x8b, y1_6_16x8b);
y0_7_16x8b = _mm_avg_epu8(y0_7_16x8b, y1_7_16x8b);
_mm_storeu_si128((__m128i *)pu1_dst, y0_0_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd), y0_1_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + (dst_strd << 1)), y0_2_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd * 3), y0_3_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + (dst_strd << 2)), y0_4_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd * 5), y0_5_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd * 6), y0_6_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd * 7), y0_7_16x8b);
ht -= 8;
pu1_src1 += src_strd1 << 3;
pu1_src2 += src_strd2 << 3;
pu1_dst += dst_strd << 3;
}
while(ht > 0);
}
}
/*****************************************************************************/
/* */
/* Function Name : ih264_default_weighted_pred_chroma_sse42 */
/* */
/* Description : This function performs the default weighted prediction */
/* as described in sec 8.4.2.3.1 titled "Default weighted */
/* sample prediction process" for chroma. The function gets */
/* two ht x wd blocks, calculates their rounded-average and */
/* stores it in the destination block. (ht,wd) can be */
/* (2,2), (4,2) , (2,4), (4,4), (8,4), (4,8) or (8,8). */
/* */
/* Inputs : pu1_src1 - Pointer to source 1 */
/* pu1_src2 - Pointer to source 2 */
/* pu1_dst - Pointer to destination */
/* src_strd1 - stride for source 1 */
/* src_strd1 - stride for source 2 */
/* dst_strd - stride for destination */
/* ht - height of the block */
/* wd - width of the block */
/* */
/* Issues : None */
/* */
/* Revision History: */
/* */
/* DD MM YYYY Author(s) Changes */
/* 04 02 2015 Kaushik Initial Version */
/* Senthoor */
/* */
/*****************************************************************************/
void ih264_default_weighted_pred_chroma_sse42(UWORD8 *pu1_src1,
UWORD8 *pu1_src2,
UWORD8 *pu1_dst,
WORD32 src_strd1,
WORD32 src_strd2,
WORD32 dst_strd,
WORD32 ht,
WORD32 wd)
{
__m128i uv0_0_16x8b, uv0_1_16x8b;
__m128i uv1_0_16x8b, uv1_1_16x8b;
if(wd == 2)
{
do
{
uv0_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src1);
uv0_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1));
uv1_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src2);
uv1_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2));
uv0_0_16x8b = _mm_avg_epu8(uv0_0_16x8b, uv1_0_16x8b);
uv0_1_16x8b = _mm_avg_epu8(uv0_1_16x8b, uv1_1_16x8b);
*((WORD32 *)(pu1_dst)) = _mm_cvtsi128_si32(uv0_0_16x8b);
*((WORD32 *)(pu1_dst + dst_strd)) = _mm_cvtsi128_si32(uv0_1_16x8b);
ht -= 2;
pu1_src1 += src_strd1 << 1;
pu1_src2 += src_strd2 << 1;
pu1_dst += dst_strd << 1;
}
while(ht > 0);
}
else if(wd == 4)
{
do
{
uv0_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src1);
uv0_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1));
uv1_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src2);
uv1_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2));
uv0_0_16x8b = _mm_avg_epu8(uv0_0_16x8b, uv1_0_16x8b);
uv0_1_16x8b = _mm_avg_epu8(uv0_1_16x8b, uv1_1_16x8b);
_mm_storel_epi64((__m128i *)pu1_dst, uv0_0_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + dst_strd), uv0_1_16x8b);
ht -= 2;
pu1_src1 += src_strd1 << 1;
pu1_src2 += src_strd2 << 1;
pu1_dst += dst_strd << 1;
}
while(ht > 0);
}
else // wd == 8
{
__m128i uv0_2_16x8b, uv0_3_16x8b;
__m128i uv1_2_16x8b, uv1_3_16x8b;
do
{
uv0_0_16x8b = _mm_loadu_si128((__m128i *)pu1_src1);
uv0_1_16x8b = _mm_loadu_si128((__m128i *)(pu1_src1 + src_strd1));
uv0_2_16x8b = _mm_loadu_si128(
(__m128i *)(pu1_src1 + (src_strd1 << 1)));
uv0_3_16x8b = _mm_loadu_si128(
(__m128i *)(pu1_src1 + src_strd1 * 3));
uv1_0_16x8b = _mm_loadu_si128((__m128i *)pu1_src2);
uv1_1_16x8b = _mm_loadu_si128((__m128i *)(pu1_src2 + src_strd2));
uv1_2_16x8b = _mm_loadu_si128(
(__m128i *)(pu1_src2 + (src_strd2 << 1)));
uv1_3_16x8b = _mm_loadu_si128(
(__m128i *)(pu1_src2 + src_strd2 * 3));
uv0_0_16x8b = _mm_avg_epu8(uv0_0_16x8b, uv1_0_16x8b);
uv0_1_16x8b = _mm_avg_epu8(uv0_1_16x8b, uv1_1_16x8b);
uv0_2_16x8b = _mm_avg_epu8(uv0_2_16x8b, uv1_2_16x8b);
uv0_3_16x8b = _mm_avg_epu8(uv0_3_16x8b, uv1_3_16x8b);
_mm_storeu_si128((__m128i *)pu1_dst, uv0_0_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd), uv0_1_16x8b);
_mm_storeu_si128(
(__m128i *)(pu1_dst + (dst_strd << 1)), uv0_2_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd * 3), uv0_3_16x8b);
ht -= 4;
pu1_src1 += src_strd1 << 2;
pu1_src2 += src_strd2 << 2;
pu1_dst += dst_strd << 2;
}
while(ht > 0);
}
}
/*****************************************************************************/
/* */
/* Function Name : ih264_weighted_pred_luma_sse42 */
/* */
/* Description : This function performs the weighted prediction as */
/* described in sec 8.4.2.3.2 titled "Weighted sample */
/* prediction process" for luma. The function gets one */
/* ht x wd block, weights it, rounds it off, offsets it, */
/* saturates it to unsigned 8-bit and stores it in the */
/* destination block. (ht,wd) can be (4,4), (8,4), (4,8), */
/* (8,8), (16,8), (8,16) or (16,16). */
/* */
/* Inputs : pu1_src - Pointer to source */
/* pu1_dst - Pointer to destination */
/* src_strd - stride for source */
/* dst_strd - stride for destination */
/* log_wd - number of bits to be rounded off */
/* wt - weight value */
/* ofst - offset value */
/* ht - height of the block */
/* wd - width of the block */
/* */
/* Issues : None */
/* */
/* Revision History: */
/* */
/* DD MM YYYY Author(s) Changes */
/* 04 02 2015 Kaushik Initial Version */
/* Senthoor */
/* */
/*****************************************************************************/
void ih264_weighted_pred_luma_sse42(UWORD8 *pu1_src,
UWORD8 *pu1_dst,
WORD32 src_strd,
WORD32 dst_strd,
WORD32 log_wd,
WORD32 wt,
WORD32 ofst,
WORD32 ht,
WORD32 wd)
{
__m128i y_0_16x8b, y_1_16x8b, y_2_16x8b, y_3_16x8b;
__m128i wt_8x16b, round_8x16b, ofst_8x16b;
WORD32 round_val;
wt = (WORD16)(wt & 0xffff);
round_val = 1 << (log_wd - 1);
ofst = (WORD8)(ofst & 0xff);
wt_8x16b = _mm_set1_epi16(wt);
round_8x16b = _mm_set1_epi16(round_val);
ofst_8x16b = _mm_set1_epi16(ofst);
if(wd == 4)
{
__m128i y_0_8x16b, y_2_8x16b;
do
{
y_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src);
y_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src + src_strd));
y_2_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src + (src_strd << 1)));
y_3_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src + src_strd * 3));
y_0_16x8b = _mm_unpacklo_epi32(y_0_16x8b, y_1_16x8b);
y_2_16x8b = _mm_unpacklo_epi32(y_2_16x8b, y_3_16x8b);
y_0_8x16b = _mm_cvtepu8_epi16(y_0_16x8b);
y_2_8x16b = _mm_cvtepu8_epi16(y_2_16x8b);
y_0_8x16b = _mm_mullo_epi16(y_0_8x16b, wt_8x16b);
y_2_8x16b = _mm_mullo_epi16(y_2_8x16b, wt_8x16b);
y_0_8x16b = _mm_adds_epi16(round_8x16b, y_0_8x16b);
y_2_8x16b = _mm_adds_epi16(round_8x16b, y_2_8x16b);
y_0_8x16b = _mm_srai_epi16(y_0_8x16b, log_wd);
y_2_8x16b = _mm_srai_epi16(y_2_8x16b, log_wd);
y_0_8x16b = _mm_adds_epi16(ofst_8x16b, y_0_8x16b);
y_2_8x16b = _mm_adds_epi16(ofst_8x16b, y_2_8x16b);
y_0_16x8b = _mm_packus_epi16(y_0_8x16b, y_2_8x16b);
y_1_16x8b = _mm_srli_si128(y_0_16x8b, 4);
y_2_16x8b = _mm_srli_si128(y_0_16x8b, 8);
y_3_16x8b = _mm_srli_si128(y_0_16x8b, 12);
*((WORD32 *)(pu1_dst)) = _mm_cvtsi128_si32(y_0_16x8b);
*((WORD32 *)(pu1_dst + dst_strd)) = _mm_cvtsi128_si32(y_1_16x8b);
*((WORD32 *)(pu1_dst + (dst_strd << 1))) = _mm_cvtsi128_si32(y_2_16x8b);
*((WORD32 *)(pu1_dst + dst_strd * 3)) = _mm_cvtsi128_si32(y_3_16x8b);
ht -= 4;
pu1_src += src_strd << 2;
pu1_dst += dst_strd << 2;
}
while(ht > 0);
}
else if(wd == 8)
{
__m128i y_0_8x16b, y_1_8x16b, y_2_8x16b, y_3_8x16b;
do
{
y_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src);
y_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src + src_strd));
y_2_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src + (src_strd << 1)));
y_3_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src + src_strd * 3));
y_0_8x16b = _mm_cvtepu8_epi16(y_0_16x8b);
y_1_8x16b = _mm_cvtepu8_epi16(y_1_16x8b);
y_2_8x16b = _mm_cvtepu8_epi16(y_2_16x8b);
y_3_8x16b = _mm_cvtepu8_epi16(y_3_16x8b);
y_0_8x16b = _mm_mullo_epi16(y_0_8x16b, wt_8x16b);
y_1_8x16b = _mm_mullo_epi16(y_1_8x16b, wt_8x16b);
y_2_8x16b = _mm_mullo_epi16(y_2_8x16b, wt_8x16b);
y_3_8x16b = _mm_mullo_epi16(y_3_8x16b, wt_8x16b);
y_0_8x16b = _mm_adds_epi16(round_8x16b, y_0_8x16b);
y_1_8x16b = _mm_adds_epi16(round_8x16b, y_1_8x16b);
y_2_8x16b = _mm_adds_epi16(round_8x16b, y_2_8x16b);
y_3_8x16b = _mm_adds_epi16(round_8x16b, y_3_8x16b);
y_0_8x16b = _mm_srai_epi16(y_0_8x16b, log_wd);
y_1_8x16b = _mm_srai_epi16(y_1_8x16b, log_wd);
y_2_8x16b = _mm_srai_epi16(y_2_8x16b, log_wd);
y_3_8x16b = _mm_srai_epi16(y_3_8x16b, log_wd);
y_0_8x16b = _mm_adds_epi16(ofst_8x16b, y_0_8x16b);
y_1_8x16b = _mm_adds_epi16(ofst_8x16b, y_1_8x16b);
y_2_8x16b = _mm_adds_epi16(ofst_8x16b, y_2_8x16b);
y_3_8x16b = _mm_adds_epi16(ofst_8x16b, y_3_8x16b);
y_0_16x8b = _mm_packus_epi16(y_0_8x16b, y_1_8x16b);
y_2_16x8b = _mm_packus_epi16(y_2_8x16b, y_3_8x16b);
y_1_16x8b = _mm_srli_si128(y_0_16x8b, 8);
y_3_16x8b = _mm_srli_si128(y_2_16x8b, 8);
_mm_storel_epi64((__m128i *)pu1_dst, y_0_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + dst_strd), y_1_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + (dst_strd << 1)), y_2_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + dst_strd * 3), y_3_16x8b);
ht -= 4;
pu1_src += src_strd << 2;
pu1_dst += dst_strd << 2;
}
while(ht > 0);
}
else // wd == 16
{
__m128i y_0L_8x16b, y_1L_8x16b, y_2L_8x16b, y_3L_8x16b;
__m128i y_0H_8x16b, y_1H_8x16b, y_2H_8x16b, y_3H_8x16b;
__m128i zero_16x8b;
zero_16x8b = _mm_set1_epi8(0);
do
{
y_0_16x8b = _mm_loadu_si128((__m128i *)pu1_src);
y_1_16x8b = _mm_loadu_si128((__m128i *)(pu1_src + src_strd));
y_2_16x8b = _mm_loadu_si128((__m128i *)(pu1_src + (src_strd << 1)));
y_3_16x8b = _mm_loadu_si128((__m128i *)(pu1_src + src_strd * 3));
y_0L_8x16b = _mm_cvtepu8_epi16(y_0_16x8b);
y_0H_8x16b = _mm_unpackhi_epi8(y_0_16x8b, zero_16x8b);
y_1L_8x16b = _mm_cvtepu8_epi16(y_1_16x8b);
y_1H_8x16b = _mm_unpackhi_epi8(y_1_16x8b, zero_16x8b);
y_2L_8x16b = _mm_cvtepu8_epi16(y_2_16x8b);
y_2H_8x16b = _mm_unpackhi_epi8(y_2_16x8b, zero_16x8b);
y_3L_8x16b = _mm_cvtepu8_epi16(y_3_16x8b);
y_3H_8x16b = _mm_unpackhi_epi8(y_3_16x8b, zero_16x8b);
y_0L_8x16b = _mm_mullo_epi16(y_0L_8x16b, wt_8x16b);
y_0H_8x16b = _mm_mullo_epi16(y_0H_8x16b, wt_8x16b);
y_1L_8x16b = _mm_mullo_epi16(y_1L_8x16b, wt_8x16b);
y_1H_8x16b = _mm_mullo_epi16(y_1H_8x16b, wt_8x16b);
y_2L_8x16b = _mm_mullo_epi16(y_2L_8x16b, wt_8x16b);
y_2H_8x16b = _mm_mullo_epi16(y_2H_8x16b, wt_8x16b);
y_3L_8x16b = _mm_mullo_epi16(y_3L_8x16b, wt_8x16b);
y_3H_8x16b = _mm_mullo_epi16(y_3H_8x16b, wt_8x16b);
y_0L_8x16b = _mm_adds_epi16(round_8x16b, y_0L_8x16b);
y_0H_8x16b = _mm_adds_epi16(round_8x16b, y_0H_8x16b);
y_1L_8x16b = _mm_adds_epi16(round_8x16b, y_1L_8x16b);
y_1H_8x16b = _mm_adds_epi16(round_8x16b, y_1H_8x16b);
y_2L_8x16b = _mm_adds_epi16(round_8x16b, y_2L_8x16b);
y_2H_8x16b = _mm_adds_epi16(round_8x16b, y_2H_8x16b);
y_3L_8x16b = _mm_adds_epi16(round_8x16b, y_3L_8x16b);
y_3H_8x16b = _mm_adds_epi16(round_8x16b, y_3H_8x16b);
y_0L_8x16b = _mm_srai_epi16(y_0L_8x16b, log_wd);
y_0H_8x16b = _mm_srai_epi16(y_0H_8x16b, log_wd);
y_1L_8x16b = _mm_srai_epi16(y_1L_8x16b, log_wd);
y_1H_8x16b = _mm_srai_epi16(y_1H_8x16b, log_wd);
y_2L_8x16b = _mm_srai_epi16(y_2L_8x16b, log_wd);
y_2H_8x16b = _mm_srai_epi16(y_2H_8x16b, log_wd);
y_3L_8x16b = _mm_srai_epi16(y_3L_8x16b, log_wd);
y_3H_8x16b = _mm_srai_epi16(y_3H_8x16b, log_wd);
y_0L_8x16b = _mm_adds_epi16(ofst_8x16b, y_0L_8x16b);
y_0H_8x16b = _mm_adds_epi16(ofst_8x16b, y_0H_8x16b);
y_1L_8x16b = _mm_adds_epi16(ofst_8x16b, y_1L_8x16b);
y_1H_8x16b = _mm_adds_epi16(ofst_8x16b, y_1H_8x16b);
y_2L_8x16b = _mm_adds_epi16(ofst_8x16b, y_2L_8x16b);
y_2H_8x16b = _mm_adds_epi16(ofst_8x16b, y_2H_8x16b);
y_3L_8x16b = _mm_adds_epi16(ofst_8x16b, y_3L_8x16b);
y_3H_8x16b = _mm_adds_epi16(ofst_8x16b, y_3H_8x16b);
y_0_16x8b = _mm_packus_epi16(y_0L_8x16b, y_0H_8x16b);
y_1_16x8b = _mm_packus_epi16(y_1L_8x16b, y_1H_8x16b);
y_2_16x8b = _mm_packus_epi16(y_2L_8x16b, y_2H_8x16b);
y_3_16x8b = _mm_packus_epi16(y_3L_8x16b, y_3H_8x16b);
_mm_storeu_si128((__m128i *)pu1_dst, y_0_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd), y_1_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + (dst_strd << 1)), y_2_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd * 3), y_3_16x8b);
ht -= 4;
pu1_src += src_strd << 2;
pu1_dst += dst_strd << 2;
}
while(ht > 0);
}
}
/*****************************************************************************/
/* */
/* Function Name : ih264_weighted_pred_chroma_sse42 */
/* */
/* Description : This function performs the weighted prediction as */
/* described in sec 8.4.2.3.2 titled "Weighted sample */
/* prediction process" for chroma. The function gets one */
/* ht x wd block, weights it, rounds it off, offsets it, */
/* saturates it to unsigned 8-bit and stores it in the */
/* destination block. (ht,wd) can be (2,2), (4,2), (2,4), */
/* (4,4), (8,4), (4,8) or (8,8). */
/* */
/* Inputs : pu1_src - Pointer to source */
/* pu1_dst - Pointer to destination */
/* src_strd - stride for source */
/* dst_strd - stride for destination */
/* log_wd - number of bits to be rounded off */
/* wt - weight values for u and v */
/* ofst - offset values for u and v */
/* ht - height of the block */
/* wd - width of the block */
/* */
/* Issues : None */
/* */
/* Revision History: */
/* */
/* DD MM YYYY Author(s) Changes */
/* 04 02 2015 Kaushik Initial Version */
/* Senthoor */
/* */
/*****************************************************************************/
void ih264_weighted_pred_chroma_sse42(UWORD8 *pu1_src,
UWORD8 *pu1_dst,
WORD32 src_strd,
WORD32 dst_strd,
WORD32 log_wd,
WORD32 wt,
WORD32 ofst,
WORD32 ht,
WORD32 wd)
{
__m128i y_0_16x8b, y_1_16x8b;
__m128i wt_8x16b, round_8x16b, ofst_8x16b;
WORD32 ofst_u, ofst_v;
WORD32 round_val;
ofst_u = (WORD8)(ofst & 0xff);
ofst_v = (WORD8)(ofst >> 8);
round_val = 1 << (log_wd - 1);
ofst = (ofst_u & 0xffff) | (ofst_v << 16);
wt_8x16b = _mm_set1_epi32(wt);
round_8x16b = _mm_set1_epi16(round_val);
ofst_8x16b = _mm_set1_epi32(ofst);
if(wd == 2)
{
__m128i y_0_8x16b;
do
{
y_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src);
y_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src + src_strd));
y_0_16x8b = _mm_unpacklo_epi32(y_0_16x8b, y_1_16x8b);
y_0_8x16b = _mm_cvtepu8_epi16(y_0_16x8b);
y_0_8x16b = _mm_mullo_epi16(y_0_8x16b, wt_8x16b);
y_0_8x16b = _mm_adds_epi16(round_8x16b, y_0_8x16b);
y_0_8x16b = _mm_srai_epi16(y_0_8x16b, log_wd);
y_0_8x16b = _mm_adds_epi16(ofst_8x16b, y_0_8x16b);
y_0_16x8b = _mm_packus_epi16(y_0_8x16b, y_0_8x16b);
y_1_16x8b = _mm_srli_si128(y_0_16x8b, 4);
*((WORD32 *)(pu1_dst)) = _mm_cvtsi128_si32(y_0_16x8b);
*((WORD32 *)(pu1_dst + dst_strd)) = _mm_cvtsi128_si32(y_1_16x8b);
ht -= 2;
pu1_src += src_strd << 1;
pu1_dst += dst_strd << 1;
}
while(ht > 0);
}
else if(wd == 4)
{
__m128i y_0_8x16b, y_1_8x16b;
do
{
y_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src);
y_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src + src_strd));
y_0_8x16b = _mm_cvtepu8_epi16(y_0_16x8b);
y_1_8x16b = _mm_cvtepu8_epi16(y_1_16x8b);
y_0_8x16b = _mm_mullo_epi16(y_0_8x16b, wt_8x16b);
y_1_8x16b = _mm_mullo_epi16(y_1_8x16b, wt_8x16b);
y_0_8x16b = _mm_adds_epi16(round_8x16b, y_0_8x16b);
y_1_8x16b = _mm_adds_epi16(round_8x16b, y_1_8x16b);
y_0_8x16b = _mm_srai_epi16(y_0_8x16b, log_wd);
y_1_8x16b = _mm_srai_epi16(y_1_8x16b, log_wd);
y_0_8x16b = _mm_adds_epi16(ofst_8x16b, y_0_8x16b);
y_1_8x16b = _mm_adds_epi16(ofst_8x16b, y_1_8x16b);
y_0_16x8b = _mm_packus_epi16(y_0_8x16b, y_1_8x16b);
y_1_16x8b = _mm_srli_si128(y_0_16x8b, 8);
_mm_storel_epi64((__m128i *)pu1_dst, y_0_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + dst_strd), y_1_16x8b);
ht -= 2;
pu1_src += src_strd << 1;
pu1_dst += dst_strd << 1;
}
while(ht > 0);
}
else // wd == 16
{
__m128i y_2_16x8b, y_3_16x8b;
__m128i y_0L_8x16b, y_1L_8x16b, y_2L_8x16b, y_3L_8x16b;
__m128i y_0H_8x16b, y_1H_8x16b, y_2H_8x16b, y_3H_8x16b;
__m128i zero_16x8b;
zero_16x8b = _mm_set1_epi8(0);
do
{
y_0_16x8b = _mm_loadu_si128((__m128i *)pu1_src);
y_1_16x8b = _mm_loadu_si128((__m128i *)(pu1_src + src_strd));
y_2_16x8b = _mm_loadu_si128((__m128i *)(pu1_src + (src_strd << 1)));
y_3_16x8b = _mm_loadu_si128((__m128i *)(pu1_src + src_strd * 3));
y_0L_8x16b = _mm_cvtepu8_epi16(y_0_16x8b);
y_0H_8x16b = _mm_unpackhi_epi8(y_0_16x8b, zero_16x8b);
y_1L_8x16b = _mm_cvtepu8_epi16(y_1_16x8b);
y_1H_8x16b = _mm_unpackhi_epi8(y_1_16x8b, zero_16x8b);
y_2L_8x16b = _mm_cvtepu8_epi16(y_2_16x8b);
y_2H_8x16b = _mm_unpackhi_epi8(y_2_16x8b, zero_16x8b);
y_3L_8x16b = _mm_cvtepu8_epi16(y_3_16x8b);
y_3H_8x16b = _mm_unpackhi_epi8(y_3_16x8b, zero_16x8b);
y_0L_8x16b = _mm_mullo_epi16(y_0L_8x16b, wt_8x16b);
y_0H_8x16b = _mm_mullo_epi16(y_0H_8x16b, wt_8x16b);
y_1L_8x16b = _mm_mullo_epi16(y_1L_8x16b, wt_8x16b);
y_1H_8x16b = _mm_mullo_epi16(y_1H_8x16b, wt_8x16b);
y_2L_8x16b = _mm_mullo_epi16(y_2L_8x16b, wt_8x16b);
y_2H_8x16b = _mm_mullo_epi16(y_2H_8x16b, wt_8x16b);
y_3L_8x16b = _mm_mullo_epi16(y_3L_8x16b, wt_8x16b);
y_3H_8x16b = _mm_mullo_epi16(y_3H_8x16b, wt_8x16b);
y_0L_8x16b = _mm_adds_epi16(round_8x16b, y_0L_8x16b);
y_0H_8x16b = _mm_adds_epi16(round_8x16b, y_0H_8x16b);
y_1L_8x16b = _mm_adds_epi16(round_8x16b, y_1L_8x16b);
y_1H_8x16b = _mm_adds_epi16(round_8x16b, y_1H_8x16b);
y_2L_8x16b = _mm_adds_epi16(round_8x16b, y_2L_8x16b);
y_2H_8x16b = _mm_adds_epi16(round_8x16b, y_2H_8x16b);
y_3L_8x16b = _mm_adds_epi16(round_8x16b, y_3L_8x16b);
y_3H_8x16b = _mm_adds_epi16(round_8x16b, y_3H_8x16b);
y_0L_8x16b = _mm_srai_epi16(y_0L_8x16b, log_wd);
y_0H_8x16b = _mm_srai_epi16(y_0H_8x16b, log_wd);
y_1L_8x16b = _mm_srai_epi16(y_1L_8x16b, log_wd);
y_1H_8x16b = _mm_srai_epi16(y_1H_8x16b, log_wd);
y_2L_8x16b = _mm_srai_epi16(y_2L_8x16b, log_wd);
y_2H_8x16b = _mm_srai_epi16(y_2H_8x16b, log_wd);
y_3L_8x16b = _mm_srai_epi16(y_3L_8x16b, log_wd);
y_3H_8x16b = _mm_srai_epi16(y_3H_8x16b, log_wd);
y_0L_8x16b = _mm_adds_epi16(ofst_8x16b, y_0L_8x16b);
y_0H_8x16b = _mm_adds_epi16(ofst_8x16b, y_0H_8x16b);
y_1L_8x16b = _mm_adds_epi16(ofst_8x16b, y_1L_8x16b);
y_1H_8x16b = _mm_adds_epi16(ofst_8x16b, y_1H_8x16b);
y_2L_8x16b = _mm_adds_epi16(ofst_8x16b, y_2L_8x16b);
y_2H_8x16b = _mm_adds_epi16(ofst_8x16b, y_2H_8x16b);
y_3L_8x16b = _mm_adds_epi16(ofst_8x16b, y_3L_8x16b);
y_3H_8x16b = _mm_adds_epi16(ofst_8x16b, y_3H_8x16b);
y_0_16x8b = _mm_packus_epi16(y_0L_8x16b, y_0H_8x16b);
y_1_16x8b = _mm_packus_epi16(y_1L_8x16b, y_1H_8x16b);
y_2_16x8b = _mm_packus_epi16(y_2L_8x16b, y_2H_8x16b);
y_3_16x8b = _mm_packus_epi16(y_3L_8x16b, y_3H_8x16b);
_mm_storeu_si128((__m128i *)pu1_dst, y_0_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd), y_1_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + (dst_strd << 1)), y_2_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd * 3), y_3_16x8b);
ht -= 4;
pu1_src += src_strd << 2;
pu1_dst += dst_strd << 2;
}
while(ht > 0);
}
}
/*****************************************************************************/
/* */
/* Function Name : ih264_weighted_bi_pred_luma_sse42 */
/* */
/* Description : This function performs the weighted biprediction as */
/* described in sec 8.4.2.3.2 titled "Weighted sample */
/* prediction process" for luma. The function gets two */
/* ht x wd blocks, weights them, adds them, rounds off the */
/* sum, offsets it, saturates it to unsigned 8-bit and */
/* stores it in the destination block. (ht,wd) can be */
/* (4,4), (8,4), (4,8), (8,8), (16,8), (8,16) or (16,16). */
/* */
/* Inputs : pu1_src1 - Pointer to source 1 */
/* pu1_src2 - Pointer to source 2 */
/* pu1_dst - Pointer to destination */
/* src_strd1 - stride for source 1 */
/* src_strd2 - stride for source 2 */
/* dst_strd2 - stride for destination */
/* log_wd - number of bits to be rounded off */
/* wt1 - weight value for source 1 */
/* wt2 - weight value for source 2 */
/* ofst1 - offset value for source 1 */
/* ofst2 - offset value for source 2 */
/* ht - height of the block */
/* wd - width of the block */
/* */
/* Issues : None */
/* */
/* Revision History: */
/* */
/* DD MM YYYY Author(s) Changes */
/* 04 02 2015 Kaushik Initial Version */
/* Senthoor */
/* */
/*****************************************************************************/
void ih264_weighted_bi_pred_luma_sse42(UWORD8 *pu1_src1,
UWORD8 *pu1_src2,
UWORD8 *pu1_dst,
WORD32 src_strd1,
WORD32 src_strd2,
WORD32 dst_strd,
WORD32 log_wd,
WORD32 wt1,
WORD32 wt2,
WORD32 ofst1,
WORD32 ofst2,
WORD32 ht,
WORD32 wd)
{
__m128i y1_0_16x8b, y1_1_16x8b;
__m128i y2_0_16x8b, y2_1_16x8b;
__m128i wt1_8x16b, wt2_8x16b;
__m128i ofst_8x16b, round_8x16b;
WORD32 ofst;
WORD32 round_val, shft;
wt1 = (WORD16)(wt1 & 0xffff);
wt2 = (WORD16)(wt2 & 0xffff);
round_val = 1 << log_wd;
shft = log_wd + 1;
ofst1 = (WORD8)(ofst1 & 0xff);
ofst2 = (WORD8)(ofst2 & 0xff);
ofst = (ofst1 + ofst2 + 1) >> 1;
wt1_8x16b = _mm_set1_epi16(wt1);
wt2_8x16b = _mm_set1_epi16(wt2);
round_8x16b = _mm_set1_epi16(round_val);
ofst_8x16b = _mm_set1_epi16(ofst);
if(wd == 4)
{
__m128i y1_2_16x8b, y1_3_16x8b;
__m128i y2_2_16x8b, y2_3_16x8b;
__m128i y1_0_8x16b, y1_2_8x16b;
__m128i y2_0_8x16b, y2_2_8x16b;
do
{
y1_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src1);
y1_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1));
y1_2_16x8b = _mm_loadl_epi64(
(__m128i *)(pu1_src1 + (src_strd1 << 1)));
y1_3_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1 * 3));
y2_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src2);
y2_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2));
y2_2_16x8b = _mm_loadl_epi64(
(__m128i *)(pu1_src2 + (src_strd2 << 1)));
y2_3_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2 * 3));
y1_0_16x8b = _mm_unpacklo_epi32(y1_0_16x8b, y1_1_16x8b);
y1_2_16x8b = _mm_unpacklo_epi32(y1_2_16x8b, y1_3_16x8b);
y2_0_16x8b = _mm_unpacklo_epi32(y2_0_16x8b, y2_1_16x8b);
y2_2_16x8b = _mm_unpacklo_epi32(y2_2_16x8b, y2_3_16x8b);
y1_0_8x16b = _mm_cvtepu8_epi16(y1_0_16x8b);
y1_2_8x16b = _mm_cvtepu8_epi16(y1_2_16x8b);
y2_0_8x16b = _mm_cvtepu8_epi16(y2_0_16x8b);
y2_2_8x16b = _mm_cvtepu8_epi16(y2_2_16x8b);
y1_0_8x16b = _mm_mullo_epi16(y1_0_8x16b, wt1_8x16b);
y2_0_8x16b = _mm_mullo_epi16(y2_0_8x16b, wt2_8x16b);
y1_2_8x16b = _mm_mullo_epi16(y1_2_8x16b, wt1_8x16b);
y2_2_8x16b = _mm_mullo_epi16(y2_2_8x16b, wt2_8x16b);
y1_0_8x16b = _mm_adds_epi16(y1_0_8x16b, y2_0_8x16b);
y1_2_8x16b = _mm_adds_epi16(y1_2_8x16b, y2_2_8x16b);
y1_0_8x16b = _mm_adds_epi16(round_8x16b, y1_0_8x16b);
y1_2_8x16b = _mm_adds_epi16(round_8x16b, y1_2_8x16b);
y1_0_8x16b = _mm_srai_epi16(y1_0_8x16b, shft);
y1_2_8x16b = _mm_srai_epi16(y1_2_8x16b, shft);
y1_0_8x16b = _mm_adds_epi16(ofst_8x16b, y1_0_8x16b);
y1_2_8x16b = _mm_adds_epi16(ofst_8x16b, y1_2_8x16b);
y1_0_16x8b = _mm_packus_epi16(y1_0_8x16b, y1_2_8x16b);
y1_1_16x8b = _mm_srli_si128(y1_0_16x8b, 4);
y1_2_16x8b = _mm_srli_si128(y1_0_16x8b, 8);
y1_3_16x8b = _mm_srli_si128(y1_0_16x8b, 12);
*((WORD32 *)(pu1_dst)) = _mm_cvtsi128_si32(y1_0_16x8b);
*((WORD32 *)(pu1_dst + dst_strd)) = _mm_cvtsi128_si32(y1_1_16x8b);
*((WORD32 *)(pu1_dst + (dst_strd << 1))) = _mm_cvtsi128_si32(y1_2_16x8b);
*((WORD32 *)(pu1_dst + dst_strd * 3)) = _mm_cvtsi128_si32(y1_3_16x8b);
ht -= 4;
pu1_src1 += src_strd1 << 2;
pu1_src2 += src_strd2 << 2;
pu1_dst += dst_strd << 2;
}
while(ht > 0);
}
else if(wd == 8)
{
__m128i y1_2_16x8b, y1_3_16x8b;
__m128i y2_2_16x8b, y2_3_16x8b;
__m128i y1_0_8x16b, y1_1_8x16b, y1_2_8x16b, y1_3_8x16b;
__m128i y2_0_8x16b, y2_1_8x16b, y2_2_8x16b, y2_3_8x16b;
do
{
y1_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src1);
y1_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1));
y1_2_16x8b = _mm_loadl_epi64(
(__m128i *)(pu1_src1 + (src_strd1 << 1)));
y1_3_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1 * 3));
y2_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src2);
y2_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2));
y2_2_16x8b = _mm_loadl_epi64(
(__m128i *)(pu1_src2 + (src_strd2 << 1)));
y2_3_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2 * 3));
y1_0_8x16b = _mm_cvtepu8_epi16(y1_0_16x8b);
y1_1_8x16b = _mm_cvtepu8_epi16(y1_1_16x8b);
y1_2_8x16b = _mm_cvtepu8_epi16(y1_2_16x8b);
y1_3_8x16b = _mm_cvtepu8_epi16(y1_3_16x8b);
y2_0_8x16b = _mm_cvtepu8_epi16(y2_0_16x8b);
y2_1_8x16b = _mm_cvtepu8_epi16(y2_1_16x8b);
y2_2_8x16b = _mm_cvtepu8_epi16(y2_2_16x8b);
y2_3_8x16b = _mm_cvtepu8_epi16(y2_3_16x8b);
y1_0_8x16b = _mm_mullo_epi16(y1_0_8x16b, wt1_8x16b);
y2_0_8x16b = _mm_mullo_epi16(y2_0_8x16b, wt2_8x16b);
y1_1_8x16b = _mm_mullo_epi16(y1_1_8x16b, wt1_8x16b);
y2_1_8x16b = _mm_mullo_epi16(y2_1_8x16b, wt2_8x16b);
y1_2_8x16b = _mm_mullo_epi16(y1_2_8x16b, wt1_8x16b);
y2_2_8x16b = _mm_mullo_epi16(y2_2_8x16b, wt2_8x16b);
y1_3_8x16b = _mm_mullo_epi16(y1_3_8x16b, wt1_8x16b);
y2_3_8x16b = _mm_mullo_epi16(y2_3_8x16b, wt2_8x16b);
y1_0_8x16b = _mm_adds_epi16(y1_0_8x16b, y2_0_8x16b);
y1_1_8x16b = _mm_adds_epi16(y1_1_8x16b, y2_1_8x16b);
y1_2_8x16b = _mm_adds_epi16(y1_2_8x16b, y2_2_8x16b);
y1_3_8x16b = _mm_adds_epi16(y1_3_8x16b, y2_3_8x16b);
y1_0_8x16b = _mm_adds_epi16(round_8x16b, y1_0_8x16b);
y1_1_8x16b = _mm_adds_epi16(round_8x16b, y1_1_8x16b);
y1_2_8x16b = _mm_adds_epi16(round_8x16b, y1_2_8x16b);
y1_3_8x16b = _mm_adds_epi16(round_8x16b, y1_3_8x16b);
y1_0_8x16b = _mm_srai_epi16(y1_0_8x16b, shft);
y1_1_8x16b = _mm_srai_epi16(y1_1_8x16b, shft);
y1_2_8x16b = _mm_srai_epi16(y1_2_8x16b, shft);
y1_3_8x16b = _mm_srai_epi16(y1_3_8x16b, shft);
y1_0_8x16b = _mm_adds_epi16(ofst_8x16b, y1_0_8x16b);
y1_1_8x16b = _mm_adds_epi16(ofst_8x16b, y1_1_8x16b);
y1_2_8x16b = _mm_adds_epi16(ofst_8x16b, y1_2_8x16b);
y1_3_8x16b = _mm_adds_epi16(ofst_8x16b, y1_3_8x16b);
y1_0_16x8b = _mm_packus_epi16(y1_0_8x16b, y1_1_8x16b);
y1_2_16x8b = _mm_packus_epi16(y1_2_8x16b, y1_3_8x16b);
y1_1_16x8b = _mm_srli_si128(y1_0_16x8b, 8);
y1_3_16x8b = _mm_srli_si128(y1_2_16x8b, 8);
_mm_storel_epi64((__m128i *)pu1_dst, y1_0_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + dst_strd), y1_1_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + (dst_strd << 1)), y1_2_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + dst_strd * 3), y1_3_16x8b);
ht -= 4;
pu1_src1 += src_strd1 << 2;
pu1_src2 += src_strd2 << 2;
pu1_dst += dst_strd << 2;
}
while(ht > 0);
}
else // wd == 16
{
__m128i y1_0L_8x16b, y1_0H_8x16b, y1_1L_8x16b, y1_1H_8x16b;
__m128i y2_0L_8x16b, y2_0H_8x16b, y2_1L_8x16b, y2_1H_8x16b;
__m128i zero_16x8b;
zero_16x8b = _mm_set1_epi8(0);
do
{
y1_0_16x8b = _mm_loadu_si128((__m128i *)pu1_src1);
y1_1_16x8b = _mm_loadu_si128((__m128i *)(pu1_src1 + src_strd1));
y2_0_16x8b = _mm_loadu_si128((__m128i *)pu1_src2);
y2_1_16x8b = _mm_loadu_si128((__m128i *)(pu1_src2 + src_strd2));
y1_0L_8x16b = _mm_cvtepu8_epi16(y1_0_16x8b);
y1_0H_8x16b = _mm_unpackhi_epi8(y1_0_16x8b, zero_16x8b);
y1_1L_8x16b = _mm_cvtepu8_epi16(y1_1_16x8b);
y1_1H_8x16b = _mm_unpackhi_epi8(y1_1_16x8b, zero_16x8b);
y2_0L_8x16b = _mm_cvtepu8_epi16(y2_0_16x8b);
y2_0H_8x16b = _mm_unpackhi_epi8(y2_0_16x8b, zero_16x8b);
y2_1L_8x16b = _mm_cvtepu8_epi16(y2_1_16x8b);
y2_1H_8x16b = _mm_unpackhi_epi8(y2_1_16x8b, zero_16x8b);
y1_0L_8x16b = _mm_mullo_epi16(y1_0L_8x16b, wt1_8x16b);
y1_0H_8x16b = _mm_mullo_epi16(y1_0H_8x16b, wt1_8x16b);
y1_1L_8x16b = _mm_mullo_epi16(y1_1L_8x16b, wt1_8x16b);
y1_1H_8x16b = _mm_mullo_epi16(y1_1H_8x16b, wt1_8x16b);
y2_0L_8x16b = _mm_mullo_epi16(y2_0L_8x16b, wt2_8x16b);
y2_0H_8x16b = _mm_mullo_epi16(y2_0H_8x16b, wt2_8x16b);
y2_1L_8x16b = _mm_mullo_epi16(y2_1L_8x16b, wt2_8x16b);
y2_1H_8x16b = _mm_mullo_epi16(y2_1H_8x16b, wt2_8x16b);
y1_0L_8x16b = _mm_adds_epi16(y1_0L_8x16b, y2_0L_8x16b);
y1_0H_8x16b = _mm_adds_epi16(y1_0H_8x16b, y2_0H_8x16b);
y1_1L_8x16b = _mm_adds_epi16(y1_1L_8x16b, y2_1L_8x16b);
y1_1H_8x16b = _mm_adds_epi16(y1_1H_8x16b, y2_1H_8x16b);
y1_0L_8x16b = _mm_adds_epi16(round_8x16b, y1_0L_8x16b);
y1_0H_8x16b = _mm_adds_epi16(round_8x16b, y1_0H_8x16b);
y1_1L_8x16b = _mm_adds_epi16(round_8x16b, y1_1L_8x16b);
y1_1H_8x16b = _mm_adds_epi16(round_8x16b, y1_1H_8x16b);
y1_0L_8x16b = _mm_srai_epi16(y1_0L_8x16b, shft);
y1_0H_8x16b = _mm_srai_epi16(y1_0H_8x16b, shft);
y1_1L_8x16b = _mm_srai_epi16(y1_1L_8x16b, shft);
y1_1H_8x16b = _mm_srai_epi16(y1_1H_8x16b, shft);
y1_0L_8x16b = _mm_adds_epi16(ofst_8x16b, y1_0L_8x16b);
y1_0H_8x16b = _mm_adds_epi16(ofst_8x16b, y1_0H_8x16b);
y1_1L_8x16b = _mm_adds_epi16(ofst_8x16b, y1_1L_8x16b);
y1_1H_8x16b = _mm_adds_epi16(ofst_8x16b, y1_1H_8x16b);
y1_0_16x8b = _mm_packus_epi16(y1_0L_8x16b, y1_0H_8x16b);
y1_1_16x8b = _mm_packus_epi16(y1_1L_8x16b, y1_1H_8x16b);
_mm_storeu_si128((__m128i *)pu1_dst, y1_0_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd), y1_1_16x8b);
ht -= 2;
pu1_src1 += src_strd1 << 1;
pu1_src2 += src_strd2 << 1;
pu1_dst += dst_strd << 1;
}
while(ht > 0);
}
}
/*****************************************************************************/
/* */
/* Function Name : ih264_weighted_bi_pred_chroma_sse42 */
/* */
/* Description : This function performs the weighted biprediction as */
/* described in sec 8.4.2.3.2 titled "Weighted sample */
/* prediction process" for chroma. The function gets two */
/* ht x wd blocks, weights them, adds them, rounds off the */
/* sum, offsets it, saturates it to unsigned 8-bit and */
/* stores it in the destination block. (ht,wd) can be */
/* (2,2), (4,2), (2,4), (4,4), (8,4), (4,8) or (8,8). */
/* */
/* Inputs : pu1_src1 - Pointer to source 1 */
/* pu1_src2 - Pointer to source 2 */
/* pu1_dst - Pointer to destination */
/* src_strd1 - stride for source 1 */
/* src_strd2 - stride for source 2 */
/* dst_strd2 - stride for destination */
/* log_wd - number of bits to be rounded off */
/* wt1 - weight values for u and v in source 1 */
/* wt2 - weight values for u and v in source 2 */
/* ofst1 - offset value for u and v in source 1 */
/* ofst2 - offset value for u and v in source 2 */
/* ht - height of the block */
/* wd - width of the block */
/* */
/* Issues : None */
/* */
/* Revision History: */
/* */
/* DD MM YYYY Author(s) Changes */
/* 04 02 2015 Kaushik Initial Version */
/* Senthoor */
/* */
/*****************************************************************************/
void ih264_weighted_bi_pred_chroma_sse42(UWORD8 *pu1_src1,
UWORD8 *pu1_src2,
UWORD8 *pu1_dst,
WORD32 src_strd1,
WORD32 src_strd2,
WORD32 dst_strd,
WORD32 log_wd,
WORD32 wt1,
WORD32 wt2,
WORD32 ofst1,
WORD32 ofst2,
WORD32 ht,
WORD32 wd)
{
__m128i y1_0_16x8b, y1_1_16x8b;
__m128i y2_0_16x8b, y2_1_16x8b;
__m128i wt1_8x16b, wt2_8x16b;
__m128i ofst_8x16b, round_8x16b;
WORD32 ofst1_u, ofst2_u, ofst_u;
WORD32 ofst1_v, ofst2_v, ofst_v;
WORD32 round_val, shft, ofst_val;
round_val = 1 << log_wd;
shft = log_wd + 1;
ofst1_u = (WORD8)(ofst1 & 0xff);
ofst1_v = (WORD8)(ofst1 >> 8);
ofst2_u = (WORD8)(ofst2 & 0xff);
ofst2_v = (WORD8)(ofst2 >> 8);
wt1_8x16b = _mm_set1_epi32(wt1);
wt2_8x16b = _mm_set1_epi32(wt2);
ofst_u = (ofst1_u + ofst2_u + 1) >> 1;
ofst_v = (ofst1_v + ofst2_v + 1) >> 1;
ofst_val = (ofst_u & 0xffff) | (ofst_v << 16);
round_8x16b = _mm_set1_epi16(round_val);
ofst_8x16b = _mm_set1_epi32(ofst_val);
if(wd == 2)
{
__m128i y1_0_8x16b, y2_0_8x16b;
do
{
y1_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src1);
y1_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1));
y2_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src2);
y2_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2));
y1_0_16x8b = _mm_unpacklo_epi32(y1_0_16x8b, y1_1_16x8b);
y2_0_16x8b = _mm_unpacklo_epi32(y2_0_16x8b, y2_1_16x8b);
y1_0_8x16b = _mm_cvtepu8_epi16(y1_0_16x8b);
y2_0_8x16b = _mm_cvtepu8_epi16(y2_0_16x8b);
y1_0_8x16b = _mm_mullo_epi16(y1_0_8x16b, wt1_8x16b);
y2_0_8x16b = _mm_mullo_epi16(y2_0_8x16b, wt2_8x16b);
y1_0_8x16b = _mm_adds_epi16(y1_0_8x16b, y2_0_8x16b);
y1_0_8x16b = _mm_adds_epi16(round_8x16b, y1_0_8x16b);
y1_0_8x16b = _mm_srai_epi16(y1_0_8x16b, shft);
y1_0_8x16b = _mm_adds_epi16(ofst_8x16b, y1_0_8x16b);
y1_0_16x8b = _mm_packus_epi16(y1_0_8x16b, y1_0_8x16b);
y1_1_16x8b = _mm_srli_si128(y1_0_16x8b, 4);
*((WORD32 *)(pu1_dst)) = _mm_cvtsi128_si32(y1_0_16x8b);
*((WORD32 *)(pu1_dst + dst_strd)) = _mm_cvtsi128_si32(y1_1_16x8b);
ht -= 2;
pu1_src1 += src_strd1 << 1;
pu1_src2 += src_strd2 << 1;
pu1_dst += dst_strd << 1;
}
while(ht > 0);
}
else if(wd == 4)
{
__m128i y1_0_8x16b, y1_1_8x16b;
__m128i y2_0_8x16b, y2_1_8x16b;
do
{
y1_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src1);
y1_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src1 + src_strd1));
y2_0_16x8b = _mm_loadl_epi64((__m128i *)pu1_src2);
y2_1_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src2 + src_strd2));
y1_0_8x16b = _mm_cvtepu8_epi16(y1_0_16x8b);
y1_1_8x16b = _mm_cvtepu8_epi16(y1_1_16x8b);
y2_0_8x16b = _mm_cvtepu8_epi16(y2_0_16x8b);
y2_1_8x16b = _mm_cvtepu8_epi16(y2_1_16x8b);
y1_0_8x16b = _mm_mullo_epi16(y1_0_8x16b, wt1_8x16b);
y2_0_8x16b = _mm_mullo_epi16(y2_0_8x16b, wt2_8x16b);
y1_1_8x16b = _mm_mullo_epi16(y1_1_8x16b, wt1_8x16b);
y2_1_8x16b = _mm_mullo_epi16(y2_1_8x16b, wt2_8x16b);
y1_0_8x16b = _mm_adds_epi16(y1_0_8x16b, y2_0_8x16b);
y1_1_8x16b = _mm_adds_epi16(y1_1_8x16b, y2_1_8x16b);
y1_0_8x16b = _mm_adds_epi16(round_8x16b, y1_0_8x16b);
y1_1_8x16b = _mm_adds_epi16(round_8x16b, y1_1_8x16b);
y1_0_8x16b = _mm_srai_epi16(y1_0_8x16b, shft);
y1_1_8x16b = _mm_srai_epi16(y1_1_8x16b, shft);
y1_0_8x16b = _mm_adds_epi16(ofst_8x16b, y1_0_8x16b);
y1_1_8x16b = _mm_adds_epi16(ofst_8x16b, y1_1_8x16b);
y1_0_16x8b = _mm_packus_epi16(y1_0_8x16b, y1_1_8x16b);
y1_1_16x8b = _mm_srli_si128(y1_0_16x8b, 8);
_mm_storel_epi64((__m128i *)pu1_dst, y1_0_16x8b);
_mm_storel_epi64((__m128i *)(pu1_dst + dst_strd), y1_1_16x8b);
ht -= 2;
pu1_src1 += src_strd1 << 1;
pu1_src2 += src_strd2 << 1;
pu1_dst += dst_strd << 1;
}
while(ht > 0);
}
else // wd == 8
{
__m128i y1_0L_8x16b, y1_0H_8x16b, y1_1L_8x16b, y1_1H_8x16b;
__m128i y2_0L_8x16b, y2_0H_8x16b, y2_1L_8x16b, y2_1H_8x16b;
__m128i zero_16x8b;
zero_16x8b = _mm_set1_epi8(0);
do
{
y1_0_16x8b = _mm_loadu_si128((__m128i *)pu1_src1);
y1_1_16x8b = _mm_loadu_si128((__m128i *)(pu1_src1 + src_strd1));
y2_0_16x8b = _mm_loadu_si128((__m128i *)pu1_src2);
y2_1_16x8b = _mm_loadu_si128((__m128i *)(pu1_src2 + src_strd2));
y1_0L_8x16b = _mm_cvtepu8_epi16(y1_0_16x8b);
y1_0H_8x16b = _mm_unpackhi_epi8(y1_0_16x8b, zero_16x8b);
y1_1L_8x16b = _mm_cvtepu8_epi16(y1_1_16x8b);
y1_1H_8x16b = _mm_unpackhi_epi8(y1_1_16x8b, zero_16x8b);
y2_0L_8x16b = _mm_cvtepu8_epi16(y2_0_16x8b);
y2_0H_8x16b = _mm_unpackhi_epi8(y2_0_16x8b, zero_16x8b);
y2_1L_8x16b = _mm_cvtepu8_epi16(y2_1_16x8b);
y2_1H_8x16b = _mm_unpackhi_epi8(y2_1_16x8b, zero_16x8b);
y1_0L_8x16b = _mm_mullo_epi16(y1_0L_8x16b, wt1_8x16b);
y1_0H_8x16b = _mm_mullo_epi16(y1_0H_8x16b, wt1_8x16b);
y1_1L_8x16b = _mm_mullo_epi16(y1_1L_8x16b, wt1_8x16b);
y1_1H_8x16b = _mm_mullo_epi16(y1_1H_8x16b, wt1_8x16b);
y2_0L_8x16b = _mm_mullo_epi16(y2_0L_8x16b, wt2_8x16b);
y2_0H_8x16b = _mm_mullo_epi16(y2_0H_8x16b, wt2_8x16b);
y2_1L_8x16b = _mm_mullo_epi16(y2_1L_8x16b, wt2_8x16b);
y2_1H_8x16b = _mm_mullo_epi16(y2_1H_8x16b, wt2_8x16b);
y1_0L_8x16b = _mm_adds_epi16(y1_0L_8x16b, y2_0L_8x16b);
y1_0H_8x16b = _mm_adds_epi16(y1_0H_8x16b, y2_0H_8x16b);
y1_1L_8x16b = _mm_adds_epi16(y1_1L_8x16b, y2_1L_8x16b);
y1_1H_8x16b = _mm_adds_epi16(y1_1H_8x16b, y2_1H_8x16b);
y1_0L_8x16b = _mm_adds_epi16(round_8x16b, y1_0L_8x16b);
y1_0H_8x16b = _mm_adds_epi16(round_8x16b, y1_0H_8x16b);
y1_1L_8x16b = _mm_adds_epi16(round_8x16b, y1_1L_8x16b);
y1_1H_8x16b = _mm_adds_epi16(round_8x16b, y1_1H_8x16b);
y1_0L_8x16b = _mm_srai_epi16(y1_0L_8x16b, shft);
y1_0H_8x16b = _mm_srai_epi16(y1_0H_8x16b, shft);
y1_1L_8x16b = _mm_srai_epi16(y1_1L_8x16b, shft);
y1_1H_8x16b = _mm_srai_epi16(y1_1H_8x16b, shft);
y1_0L_8x16b = _mm_adds_epi16(ofst_8x16b, y1_0L_8x16b);
y1_0H_8x16b = _mm_adds_epi16(ofst_8x16b, y1_0H_8x16b);
y1_1L_8x16b = _mm_adds_epi16(ofst_8x16b, y1_1L_8x16b);
y1_1H_8x16b = _mm_adds_epi16(ofst_8x16b, y1_1H_8x16b);
y1_0_16x8b = _mm_packus_epi16(y1_0L_8x16b, y1_0H_8x16b);
y1_1_16x8b = _mm_packus_epi16(y1_1L_8x16b, y1_1H_8x16b);
_mm_storeu_si128((__m128i *)pu1_dst, y1_0_16x8b);
_mm_storeu_si128((__m128i *)(pu1_dst + dst_strd), y1_1_16x8b);
ht -= 2;
pu1_src1 += src_strd1 << 1;
pu1_src2 += src_strd2 << 1;
pu1_dst += dst_strd << 1;
}
while(ht > 0);
}
}
Reference in New Issue View Git Blame Copy Permalink