| /****************************************************************************** |
| * |
| * 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 |
| * ih264e_intra_modes_eval_ssse3.c |
| * |
| * @brief |
| * This file contains definitions of routines that perform rate distortion |
| * analysis on a macroblock if they are to be coded as intra. |
| * |
| * @author |
| * Ittiam |
| * |
| * @par List of Functions: |
| * ih264e_evaluate_intra16x16_modes_ssse3 |
| * ih264e_evaluate_intra_4x4_modes_ssse3 |
| * ih264e_evaluate_intra_chroma_modes_ssse3 |
| * |
| * @remarks |
| * None |
| * |
| ******************************************************************************* |
| */ |
| |
| /*****************************************************************************/ |
| /* File Includes */ |
| /*****************************************************************************/ |
| |
| /* System include files */ |
| #include <stdio.h> |
| #include <string.h> |
| #include <limits.h> |
| #include <assert.h> |
| #include <immintrin.h> |
| |
| /* User include files */ |
| #include "ih264e_config.h" |
| #include "ih264_typedefs.h" |
| #include "ih264e_defs.h" |
| #include "iv2.h" |
| #include "ive2.h" |
| #include "ih264_debug.h" |
| #include "ih264_defs.h" |
| #include "ih264_macros.h" |
| #include "ih264_intra_pred_filters.h" |
| #include "ih264_structs.h" |
| #include "ih264_common_tables.h" |
| #include "ih264_trans_quant_itrans_iquant.h" |
| #include "ih264_inter_pred_filters.h" |
| #include "ih264_mem_fns.h" |
| #include "ih264_padding.h" |
| #include "ih264_deblk_edge_filters.h" |
| #include "ime_distortion_metrics.h" |
| #include "ih264e_error.h" |
| #include "ih264e_bitstream.h" |
| #include "ime_defs.h" |
| #include "ime_structs.h" |
| #include "ih264_cabac_tables.h" |
| #include "irc_cntrl_param.h" |
| #include "irc_frame_info_collector.h" |
| #include "ih264e_rate_control.h" |
| |
| #include "ih264e_cabac_structs.h" |
| #include "ih264e_structs.h" |
| #include "ih264e_cabac.h" |
| #include "ih264e_intra_modes_eval.h" |
| #include "ih264e_globals.h" |
| #include "ime_platform_macros.h" |
| |
| |
| /*****************************************************************************/ |
| /* Function Definitions */ |
| /*****************************************************************************/ |
| /** |
| ****************************************************************************** |
| * |
| * @brief |
| * evaluate best intra 16x16 mode (among VERT, HORZ and DC) and do the |
| * prediction. |
| * |
| * @par Description |
| * This function evaluates first three 16x16 modes and compute corresponding |
| * SAD and returns the buffer predicted with best mode. |
| * |
| * @param[in] pu1_src |
| * UWORD8 pointer to the source |
| * |
| * @param[in] pu1_ngbr_pels_i16 |
| * UWORD8 pointer to neighbouring pels |
| * |
| * @param[out] pu1_dst |
| * UWORD8 pointer to the destination |
| * |
| * @param[in] src_strd |
| * integer source stride |
| * |
| * @param[in] dst_strd |
| * integer destination stride |
| * |
| * @param[in] u4_n_avblty |
| * availability of neighbouring pixels |
| * |
| * @param[in] u4_intra_mode |
| * pointer to the variable in which best mode is returned |
| * |
| * @param[in] pu4_sadmin |
| * pointer to the variable in which minimum sad is returned |
| * |
| * @param[in] u4_valid_intra_modes |
| * says what all modes are valid |
| * |
| * @return |
| * None |
| * |
| ****************************************************************************** |
| */ |
| void ih264e_evaluate_intra16x16_modes_ssse3(UWORD8 *pu1_src, |
| UWORD8 *pu1_ngbr_pels_i16, |
| UWORD8 *pu1_dst, |
| UWORD32 src_strd, |
| UWORD32 dst_strd, |
| WORD32 n_avblty, |
| UWORD32 *u4_intra_mode, |
| WORD32 *pu4_sadmin, |
| UWORD32 u4_valid_intra_modes) |
| { |
| UWORD8 *pu1_src_temp; |
| |
| WORD32 left, top, horz_flag, vert_flag, dc_flag; |
| WORD32 sad_vert, sad_horz, sad_dc, min_sad; |
| |
| WORD32 cnt, dcval; |
| WORD32 src_strd2, src_strd3, src_strd4; |
| WORD32 dst_strd2, dst_strd3, dst_strd4; |
| |
| __m128i src1_16x8b, src2_16x8b, src3_16x8b, src4_16x8b; |
| __m128i val1_16x8b, val2_16x8b, val3_16x8b, val4_16x8b; |
| __m128i sad1_8x16b, sad2_8x16b, sad3_8x16b, sad4_8x16b; |
| |
| __m128i sad_8x16b, val_16x8b, zero_vector; |
| |
| sad_vert = INT_MAX; |
| sad_horz = INT_MAX; |
| sad_dc = INT_MAX; |
| |
| src_strd2 = src_strd << 1; |
| src_strd4 = src_strd << 2; |
| src_strd3 = src_strd + src_strd2; |
| |
| dst_strd2 = dst_strd << 1; |
| dst_strd4 = dst_strd << 2; |
| dst_strd3 = dst_strd + dst_strd2; |
| |
| left = (n_avblty & LEFT_MB_AVAILABLE_MASK); |
| top = (n_avblty & TOP_MB_AVAILABLE_MASK) >> 2; |
| |
| zero_vector = _mm_setzero_si128(); |
| |
| horz_flag = left && ((u4_valid_intra_modes & 02) != 0); |
| vert_flag = top && ((u4_valid_intra_modes & 01) != 0); |
| dc_flag = (u4_valid_intra_modes & 04) != 0; |
| |
| if(horz_flag) |
| { |
| pu1_src_temp = pu1_src; |
| |
| val1_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[15]); |
| val2_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[14]); |
| val3_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[13]); |
| val4_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[12]); |
| |
| src1_16x8b = _mm_loadu_si128((__m128i *)pu1_src_temp); |
| src2_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd)); |
| src3_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd2)); |
| src4_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd3)); |
| |
| sad1_8x16b = _mm_sad_epu8(val1_16x8b, src1_16x8b); |
| sad2_8x16b = _mm_sad_epu8(val2_16x8b, src2_16x8b); |
| sad3_8x16b = _mm_sad_epu8(val3_16x8b, src3_16x8b); |
| sad4_8x16b = _mm_sad_epu8(val4_16x8b, src4_16x8b); |
| |
| sad1_8x16b = _mm_packs_epi32(sad1_8x16b, sad2_8x16b); |
| sad3_8x16b = _mm_packs_epi32(sad3_8x16b, sad4_8x16b); |
| |
| cnt = 11; |
| sad_8x16b = _mm_packs_epi32(sad1_8x16b, sad3_8x16b); |
| do |
| { |
| pu1_src_temp += src_strd4; |
| |
| val1_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[cnt]); |
| val2_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[cnt - 1]); |
| val3_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[cnt - 2]); |
| val4_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[cnt - 3]); |
| |
| src1_16x8b = _mm_loadu_si128((__m128i *)pu1_src_temp); |
| src2_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd)); |
| src3_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd2)); |
| src4_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd3)); |
| |
| sad1_8x16b = _mm_sad_epu8(val1_16x8b, src1_16x8b); |
| sad2_8x16b = _mm_sad_epu8(val2_16x8b, src2_16x8b); |
| sad3_8x16b = _mm_sad_epu8(val3_16x8b, src3_16x8b); |
| sad4_8x16b = _mm_sad_epu8(val4_16x8b, src4_16x8b); |
| |
| sad1_8x16b = _mm_packs_epi32(sad1_8x16b, sad2_8x16b); |
| sad3_8x16b = _mm_packs_epi32(sad3_8x16b, sad4_8x16b); |
| sad1_8x16b = _mm_packs_epi32(sad1_8x16b, sad3_8x16b); |
| |
| cnt -= 4; |
| sad_8x16b = _mm_add_epi16(sad_8x16b, sad1_8x16b); |
| } |
| while(cnt >= 0); |
| |
| sad_8x16b = _mm_hadd_epi16(sad_8x16b, sad_8x16b); |
| sad_8x16b = _mm_hadd_epi16(sad_8x16b, sad_8x16b); |
| sad_8x16b = _mm_hadd_epi16(sad_8x16b, sad_8x16b); |
| |
| sad_horz = _mm_extract_epi16(sad_8x16b, 0); |
| } |
| |
| if(vert_flag) |
| { |
| pu1_src_temp = pu1_src; |
| |
| val1_16x8b = _mm_loadu_si128((__m128i *)(pu1_ngbr_pels_i16 + 17)); |
| |
| src1_16x8b = _mm_loadu_si128((__m128i *)pu1_src_temp); |
| src2_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd)); |
| src3_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd2)); |
| src4_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd3)); |
| |
| sad1_8x16b = _mm_sad_epu8(val1_16x8b, src1_16x8b); |
| sad2_8x16b = _mm_sad_epu8(val1_16x8b, src2_16x8b); |
| sad3_8x16b = _mm_sad_epu8(val1_16x8b, src3_16x8b); |
| sad4_8x16b = _mm_sad_epu8(val1_16x8b, src4_16x8b); |
| |
| sad1_8x16b = _mm_packs_epi32(sad1_8x16b, sad2_8x16b); |
| sad3_8x16b = _mm_packs_epi32(sad3_8x16b, sad4_8x16b); |
| |
| cnt = 11; |
| sad_8x16b = _mm_packs_epi32(sad1_8x16b, sad3_8x16b); |
| do |
| { |
| pu1_src_temp += src_strd4; |
| |
| src1_16x8b = _mm_loadu_si128((__m128i *)pu1_src_temp); |
| src2_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd)); |
| src3_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd2)); |
| src4_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd3)); |
| |
| sad1_8x16b = _mm_sad_epu8(val1_16x8b, src1_16x8b); |
| sad2_8x16b = _mm_sad_epu8(val1_16x8b, src2_16x8b); |
| sad3_8x16b = _mm_sad_epu8(val1_16x8b, src3_16x8b); |
| sad4_8x16b = _mm_sad_epu8(val1_16x8b, src4_16x8b); |
| |
| sad1_8x16b = _mm_packs_epi32(sad1_8x16b, sad2_8x16b); |
| sad3_8x16b = _mm_packs_epi32(sad3_8x16b, sad4_8x16b); |
| sad1_8x16b = _mm_packs_epi32(sad1_8x16b, sad3_8x16b); |
| |
| cnt -= 4; |
| sad_8x16b = _mm_add_epi16(sad_8x16b, sad1_8x16b); |
| } |
| while(cnt >= 0); |
| |
| sad_8x16b = _mm_hadd_epi16(sad_8x16b, sad_8x16b); |
| sad_8x16b = _mm_hadd_epi16(sad_8x16b, sad_8x16b); |
| sad_8x16b = _mm_hadd_epi16(sad_8x16b, sad_8x16b); |
| |
| sad_vert = _mm_extract_epi16(sad_8x16b, 0); |
| } |
| |
| dcval = 0; |
| |
| if(left) |
| { |
| val_16x8b = _mm_loadu_si128((__m128i *)pu1_ngbr_pels_i16); |
| dcval += 8; |
| |
| sad1_8x16b = _mm_sad_epu8(val_16x8b, zero_vector); |
| dcval += _mm_extract_epi16(sad1_8x16b, 0); |
| dcval += _mm_extract_epi16(sad1_8x16b, 4); |
| } |
| if(top) |
| { |
| val_16x8b = _mm_loadu_si128((__m128i *)(pu1_ngbr_pels_i16 + 17)); |
| dcval += 8; |
| |
| sad1_8x16b = _mm_sad_epu8(val_16x8b, zero_vector); |
| dcval += _mm_extract_epi16(sad1_8x16b, 0); |
| dcval += _mm_extract_epi16(sad1_8x16b, 4); |
| } |
| dcval = dcval >> (3 + left + top); |
| dcval += ((left == 0) & (top == 0)) << 7; |
| |
| if(dc_flag) |
| { |
| pu1_src_temp = pu1_src; |
| val1_16x8b = _mm_set1_epi8(dcval); |
| |
| src1_16x8b = _mm_loadu_si128((__m128i *)pu1_src_temp); |
| src2_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd)); |
| src3_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd2)); |
| src4_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd3)); |
| |
| sad1_8x16b = _mm_sad_epu8(val1_16x8b, src1_16x8b); |
| sad2_8x16b = _mm_sad_epu8(val1_16x8b, src2_16x8b); |
| sad3_8x16b = _mm_sad_epu8(val1_16x8b, src3_16x8b); |
| sad4_8x16b = _mm_sad_epu8(val1_16x8b, src4_16x8b); |
| |
| sad1_8x16b = _mm_packs_epi32(sad1_8x16b, sad2_8x16b); |
| sad3_8x16b = _mm_packs_epi32(sad3_8x16b, sad4_8x16b); |
| |
| cnt = 12; |
| sad_8x16b = _mm_packs_epi32(sad1_8x16b, sad3_8x16b); |
| do |
| { |
| pu1_src_temp += src_strd4; |
| |
| src1_16x8b = _mm_loadu_si128((__m128i *)pu1_src_temp); |
| src2_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd)); |
| src3_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd2)); |
| src4_16x8b = _mm_loadu_si128((__m128i *)(pu1_src_temp + src_strd3)); |
| |
| sad1_8x16b = _mm_sad_epu8(val1_16x8b, src1_16x8b); |
| sad2_8x16b = _mm_sad_epu8(val1_16x8b, src2_16x8b); |
| sad3_8x16b = _mm_sad_epu8(val1_16x8b, src3_16x8b); |
| sad4_8x16b = _mm_sad_epu8(val1_16x8b, src4_16x8b); |
| |
| sad1_8x16b = _mm_packs_epi32(sad1_8x16b, sad2_8x16b); |
| sad3_8x16b = _mm_packs_epi32(sad3_8x16b, sad4_8x16b); |
| sad1_8x16b = _mm_packs_epi32(sad1_8x16b, sad3_8x16b); |
| |
| cnt -= 4; |
| sad_8x16b = _mm_add_epi16(sad_8x16b, sad1_8x16b); |
| } |
| while(cnt > 0); |
| |
| sad_8x16b = _mm_hadd_epi16(sad_8x16b, sad_8x16b); |
| sad_8x16b = _mm_hadd_epi16(sad_8x16b, sad_8x16b); |
| sad_8x16b = _mm_hadd_epi16(sad_8x16b, sad_8x16b); |
| |
| sad_dc = _mm_extract_epi16(sad_8x16b, 0); |
| } |
| |
| // Doing prediction for minimum SAD |
| min_sad = MIN3(sad_horz, sad_vert, sad_dc); |
| if(min_sad < *pu4_sadmin) |
| { |
| *pu4_sadmin = min_sad; |
| if(min_sad == sad_vert) |
| { |
| *u4_intra_mode = VERT_I16x16; |
| val1_16x8b = _mm_loadu_si128((__m128i *)(pu1_ngbr_pels_i16 + 17)); |
| cnt = 15; |
| do |
| { |
| _mm_storeu_si128((__m128i *)pu1_dst, val1_16x8b); |
| _mm_storeu_si128((__m128i *)(pu1_dst + dst_strd), val1_16x8b); |
| _mm_storeu_si128((__m128i *)(pu1_dst + dst_strd2), val1_16x8b); |
| _mm_storeu_si128((__m128i *)(pu1_dst + dst_strd3), val1_16x8b); |
| |
| cnt -= 4; |
| pu1_dst += dst_strd4; |
| } |
| while(cnt > 0); |
| } |
| else if(min_sad == sad_horz) |
| { |
| *u4_intra_mode = HORZ_I16x16; |
| cnt = 15; |
| do |
| { |
| val1_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[cnt]); |
| val2_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[cnt - 1]); |
| val3_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[cnt - 2]); |
| val4_16x8b = _mm_set1_epi8(pu1_ngbr_pels_i16[cnt - 3]); |
| |
| _mm_storeu_si128((__m128i *)pu1_dst, val1_16x8b); |
| _mm_storeu_si128((__m128i *)(pu1_dst + dst_strd), val2_16x8b); |
| _mm_storeu_si128((__m128i *)(pu1_dst + dst_strd2), val3_16x8b); |
| _mm_storeu_si128((__m128i *)(pu1_dst + dst_strd3), val4_16x8b); |
| |
| cnt -= 4; |
| pu1_dst += dst_strd4; |
| } |
| while(cnt >= 0); |
| } |
| else |
| { |
| *u4_intra_mode = DC_I16x16; |
| val1_16x8b = _mm_set1_epi8(dcval); |
| cnt = 15; |
| do |
| { |
| _mm_storeu_si128((__m128i *)pu1_dst, val1_16x8b); |
| _mm_storeu_si128((__m128i *)(pu1_dst + dst_strd), val1_16x8b); |
| _mm_storeu_si128((__m128i *)(pu1_dst + dst_strd2), val1_16x8b); |
| _mm_storeu_si128((__m128i *)(pu1_dst + dst_strd3), val1_16x8b); |
| |
| cnt -= 4; |
| pu1_dst += dst_strd4; |
| } |
| while(cnt > 0); |
| } |
| } |
| } |
| |
| /** |
| ****************************************************************************** |
| * |
| * @brief :Evaluate best intra 4x4 mode and do the prediction. |
| * |
| * @par Description |
| * This function evaluates intra 4x4 modes, computes corresponding sad |
| * and returns the buffer predicted with best mode. |
| * |
| * @param[in] pu1_src |
| * UWORD8 pointer to the source |
| * |
| ** @param[in] pu1_ngbr_pels |
| * UWORD8 pointer to neighbouring pels |
| * |
| * @param[out] pu1_dst |
| * UWORD8 pointer to the destination |
| * |
| * @param[in] src_strd |
| * integer source stride |
| * |
| * @param[in] dst_strd |
| * integer destination stride |
| * |
| * @param[in] u4_n_avblty |
| * availability of neighbouring pixels |
| * |
| * @param[in] u4_intra_mode |
| * Pointer to the variable in which best mode is returned |
| * |
| * @param[in] pu4_sadmin |
| * Pointer to the variable in which minimum cost is returned |
| * |
| * @param[in] u4_valid_intra_modes |
| * Says what all modes are valid |
| * |
| * * @param[in] u4_lambda |
| * Lamda value for computing cost from SAD |
| * |
| * @param[in] u4_predictd_mode |
| * Predicted mode for cost computation |
| * |
| * @return none |
| * |
| ****************************************************************************** |
| */ |
| void ih264e_evaluate_intra_4x4_modes_ssse3(UWORD8 *pu1_src, |
| UWORD8 *pu1_ngbr_pels, |
| UWORD8 *pu1_dst, |
| UWORD32 src_strd, |
| UWORD32 dst_strd, |
| WORD32 u4_n_avblty, |
| UWORD32 *u4_intra_mode, |
| WORD32 *pu4_sadmin, |
| UWORD32 u4_valid_intra_modes, |
| UWORD32 u4_lambda, |
| UWORD32 u4_predictd_mode) |
| { |
| WORD32 left, top; |
| WORD32 sad[MAX_I4x4] = { INT_MAX, INT_MAX, INT_MAX, INT_MAX, INT_MAX, |
| INT_MAX, INT_MAX, INT_MAX, INT_MAX }; |
| WORD32 cost[MAX_I4x4] = { INT_MAX, INT_MAX, INT_MAX, INT_MAX, INT_MAX, |
| INT_MAX, INT_MAX, INT_MAX, INT_MAX }; |
| |
| WORD32 min_cost; |
| UWORD32 lambda4 = u4_lambda << 2; |
| WORD32 dst_strd2, dst_strd3; |
| |
| __m128i left_top_16x8b, src_16x8b, pred0_16x8b, sad_8x16b; |
| __m128i pred1_16x8b, pred2_16x8b, pred3_16x8b, pred4_16x8b; |
| __m128i pred5_16x8b, pred6_16x8b, pred7_16x8b, pred8_16x8b; |
| __m128i shuffle_16x8b, zero_vector, mask_low_32b; |
| |
| left = (u4_n_avblty & LEFT_MB_AVAILABLE_MASK); |
| top = (u4_n_avblty & TOP_MB_AVAILABLE_MASK) >> 2; |
| |
| dst_strd2 = dst_strd << 1; |
| dst_strd3 = dst_strd + dst_strd2; |
| |
| // loading the 4x4 source block and neighbouring pixels |
| { |
| __m128i row1_16x8b, row2_16x8b; |
| |
| row1_16x8b = _mm_loadl_epi64((__m128i *)pu1_src); |
| row2_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src + src_strd)); |
| left_top_16x8b = _mm_loadu_si128((__m128i *)pu1_ngbr_pels); |
| |
| pu1_src += src_strd << 1; |
| src_16x8b = _mm_unpacklo_epi32(row1_16x8b, row2_16x8b); |
| |
| row1_16x8b = _mm_loadl_epi64((__m128i *)pu1_src); |
| row2_16x8b = _mm_loadl_epi64((__m128i *)(pu1_src + src_strd)); |
| zero_vector = _mm_setzero_si128(); |
| |
| row1_16x8b = _mm_unpacklo_epi32(row1_16x8b, row2_16x8b); |
| src_16x8b = _mm_unpacklo_epi64(src_16x8b, row1_16x8b); |
| } |
| |
| /* Computing SADs*/ |
| if(u4_valid_intra_modes & 1)/* VERT mode valid ????*/ |
| { |
| pred0_16x8b = _mm_srli_si128(left_top_16x8b, 5); |
| pred0_16x8b = _mm_shuffle_epi32(pred0_16x8b, 0); |
| sad_8x16b = _mm_sad_epu8(src_16x8b, pred0_16x8b); |
| |
| sad[VERT_I4x4] = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| cost[VERT_I4x4] = sad[VERT_I4x4] + ((u4_predictd_mode == VERT_I4x4) ? u4_lambda: lambda4); |
| } |
| |
| if(u4_valid_intra_modes & 2)/* HORZ mode valid ????*/ |
| { |
| shuffle_16x8b = _mm_setr_epi8(3, 3, 3, 3, 2, 2, 2, 2, 1, 1, 1, 1, 0, 0, 0, 0); |
| pred1_16x8b = _mm_shuffle_epi8(left_top_16x8b, shuffle_16x8b); |
| |
| sad_8x16b = _mm_sad_epu8(src_16x8b, pred1_16x8b); |
| |
| sad[HORZ_I4x4] = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| cost[HORZ_I4x4] = sad[HORZ_I4x4] + ((u4_predictd_mode == HORZ_I4x4) ? u4_lambda: lambda4); |
| } |
| |
| if(u4_valid_intra_modes & 4)/* DC mode valid ????*/ |
| { |
| if(top + left) |
| { |
| WORD32 shft = 1, dcval = 0; |
| |
| __m128i val_16x8b, temp_16x8b, temp_8x16b; |
| |
| val_16x8b = _mm_setzero_si128(); |
| |
| if(top) |
| { |
| temp_16x8b = _mm_srli_si128(left_top_16x8b, 5); |
| val_16x8b = _mm_alignr_epi8(temp_16x8b, val_16x8b, 4); |
| shft ++; |
| dcval += 2; |
| } |
| if(left) |
| { |
| val_16x8b = _mm_alignr_epi8(left_top_16x8b, val_16x8b, 4); |
| shft++; |
| dcval += 2; |
| } |
| |
| temp_8x16b = _mm_sad_epu8(val_16x8b, zero_vector); |
| dcval += _mm_extract_epi16(temp_8x16b, 4); |
| dcval = dcval >> shft; |
| pred2_16x8b = _mm_set1_epi8(dcval); |
| } |
| else |
| pred2_16x8b = _mm_set1_epi8(128); |
| |
| sad_8x16b = _mm_sad_epu8(src_16x8b, pred2_16x8b); |
| |
| sad[DC_I4x4] = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| cost[DC_I4x4] = sad[DC_I4x4] + ((u4_predictd_mode == DC_I4x4) ? u4_lambda: lambda4); |
| } |
| |
| if(u4_valid_intra_modes > 7)/* if modes other than VERT, HORZ and DC are valid ????*/ |
| { |
| __m128i w11_16x8b, w121_16x8b; |
| __m128i temp1_16x8b, temp2_16x8b; |
| |
| /* Performing FILT121 and FILT11 operation for all neighbour values*/ |
| { |
| __m128i temp1_8x16b, temp2_8x16b, temp3_8x16b; |
| __m128i const_2_8x16b; |
| |
| const_2_8x16b = _mm_set1_epi16(2); |
| |
| temp1_8x16b = _mm_unpacklo_epi8(left_top_16x8b, zero_vector); //l3 l2 l1 l0 tl t0 t1 t2 |
| temp2_8x16b = _mm_slli_si128(temp1_8x16b, 2); // 0 l3 l2 l1 l0 tl t0 t1 |
| temp2_8x16b = _mm_shufflelo_epi16(temp2_8x16b, 0xe5); //l3 l3 l2 l1 l0 tl t0 t1 |
| |
| temp1_8x16b = _mm_add_epi16(temp1_8x16b, temp2_8x16b); //l3+l3 l3+l2 l2+l1... t1+t2 |
| temp2_8x16b = _mm_slli_si128(temp1_8x16b, 2); //l3+l3 l3+l3 l3+l2... t0+t1 |
| temp2_8x16b = _mm_shufflelo_epi16(temp2_8x16b, 0xe5); |
| temp1_8x16b = _mm_add_epi16(temp1_8x16b, temp2_8x16b); //4*l3 l3+2*l3+l2 l3+2*l2+l1... t0+2*t1+t2 |
| |
| temp1_8x16b = _mm_add_epi16(const_2_8x16b, temp1_8x16b); //4*l3+2 3*l3+l2+2 l3+2*l2+l1+2.. t0+2*t1+t2+2 |
| temp1_8x16b = _mm_srli_epi16(temp1_8x16b, 2); |
| |
| temp1_16x8b = _mm_srli_si128(left_top_16x8b, 1); |
| w11_16x8b = _mm_avg_epu8(left_top_16x8b, temp1_16x8b); |
| |
| temp2_16x8b = _mm_srli_si128(left_top_16x8b, 6); |
| temp2_8x16b = _mm_unpacklo_epi8(temp2_16x8b, zero_vector); //t1 t2 t3 t4 t5 t6 t7 0 |
| temp3_8x16b = _mm_srli_si128(temp2_8x16b, 2); //t2 t3 t4 t5 t6 t7 0 0 |
| temp3_8x16b = _mm_shufflehi_epi16(temp3_8x16b, 0xd4); //t2 t3 t4 t5 t6 t7 t7 0 |
| |
| temp2_8x16b = _mm_add_epi16(temp2_8x16b, temp3_8x16b); //t1+t2 t2+t3... t6+t7 t7+t7 0 |
| temp3_8x16b = _mm_srli_si128(temp2_8x16b, 2); //t2+t3 t3+t4... t7+t7 0 0 |
| temp2_8x16b = _mm_add_epi16(temp2_8x16b, temp3_8x16b); //t1+2*t2+t3 t2+2*t3+t4.. t6+2*t7+t7 t7+t7 0 |
| |
| temp2_8x16b = _mm_add_epi16(const_2_8x16b, temp2_8x16b); //t1+2*t2+t3+2 t2+2*t3+t4+2 t3+2*t4+t5+2... t6+2*t7+t7+2 t7+t7+2 2 |
| temp2_8x16b = _mm_srli_epi16(temp2_8x16b, 2); |
| |
| w121_16x8b = _mm_packus_epi16(temp1_8x16b, temp2_8x16b); |
| } |
| |
| if(u4_valid_intra_modes & 8)/* DIAG_DL */ |
| { |
| shuffle_16x8b = _mm_setr_epi8( 7, 8, 9, 10, |
| 8, 9, 10, 11, |
| 9, 10, 11, 12, |
| 10, 11, 12, 13); |
| pred3_16x8b = _mm_shuffle_epi8(w121_16x8b, shuffle_16x8b); |
| sad_8x16b = _mm_sad_epu8(src_16x8b, pred3_16x8b); |
| |
| sad[DIAG_DL_I4x4] = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| cost[DIAG_DL_I4x4] = sad[DIAG_DL_I4x4] + ((u4_predictd_mode == DIAG_DL_I4x4) ? u4_lambda: lambda4); |
| } |
| |
| if(u4_valid_intra_modes & 16)/* DIAG_DR */ |
| { |
| shuffle_16x8b = _mm_setr_epi8(5, 6, 7, 8, |
| 4, 5, 6, 7, |
| 3, 4, 5, 6, |
| 2, 3, 4, 5); |
| pred4_16x8b = _mm_shuffle_epi8(w121_16x8b, shuffle_16x8b); |
| sad_8x16b = _mm_sad_epu8(src_16x8b, pred4_16x8b); |
| |
| sad[DIAG_DR_I4x4] = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| cost[DIAG_DR_I4x4] = sad[DIAG_DR_I4x4] + ((u4_predictd_mode == DIAG_DR_I4x4) ? u4_lambda: lambda4); |
| } |
| |
| if(u4_valid_intra_modes & 32)/* VERT_R mode valid ????*/ |
| { |
| temp1_16x8b = _mm_srli_si128(w121_16x8b, 1); |
| temp1_16x8b = _mm_unpacklo_epi64(temp1_16x8b, w11_16x8b); |
| shuffle_16x8b = _mm_setr_epi8(12, 13, 14, 15, |
| 4, 5, 6, 7, |
| 3, 12, 13, 14, |
| 2, 4, 5, 6); |
| pred5_16x8b = _mm_shuffle_epi8(temp1_16x8b, shuffle_16x8b); |
| sad_8x16b = _mm_sad_epu8(src_16x8b, pred5_16x8b); |
| |
| sad[VERT_R_I4x4] = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| cost[VERT_R_I4x4] = sad[VERT_R_I4x4] + ((u4_predictd_mode == VERT_R_I4x4) ? u4_lambda: lambda4); |
| } |
| |
| if(u4_valid_intra_modes & 64)/* HORZ_D mode valid ????*/ |
| { |
| temp1_16x8b = _mm_unpacklo_epi64(w121_16x8b, w11_16x8b); |
| shuffle_16x8b = _mm_setr_epi8(11, 5, 6, 7, |
| 10, 4, 11, 5, |
| 9, 3, 10, 4, |
| 8, 2, 9, 3); |
| pred6_16x8b = _mm_shuffle_epi8(temp1_16x8b, shuffle_16x8b); |
| sad_8x16b = _mm_sad_epu8(src_16x8b, pred6_16x8b); |
| |
| sad[HORZ_D_I4x4] = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| cost[HORZ_D_I4x4] = sad[HORZ_D_I4x4] + ((u4_predictd_mode == HORZ_D_I4x4) ? u4_lambda: lambda4); |
| } |
| |
| if(u4_valid_intra_modes & 128)/* VERT_L mode valid ????*/ |
| { |
| temp1_16x8b = _mm_srli_si128(w121_16x8b, 5); |
| temp2_16x8b = _mm_srli_si128(w11_16x8b, 5); |
| temp1_16x8b = _mm_unpacklo_epi64(temp1_16x8b, temp2_16x8b); |
| shuffle_16x8b = _mm_setr_epi8(8, 9, 10, 11, |
| 2, 3, 4, 5, |
| 9, 10, 11, 12, |
| 3, 4, 5, 6); |
| pred7_16x8b = _mm_shuffle_epi8(temp1_16x8b, shuffle_16x8b); |
| sad_8x16b = _mm_sad_epu8(src_16x8b, pred7_16x8b); |
| |
| sad[VERT_L_I4x4] = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| cost[VERT_L_I4x4] = sad[VERT_L_I4x4] + ((u4_predictd_mode == VERT_L_I4x4) ? u4_lambda: lambda4); |
| } |
| |
| if(u4_valid_intra_modes & 256)/* HORZ_U mode valid ????*/ |
| { |
| temp1_16x8b = _mm_unpacklo_epi64(w121_16x8b, w11_16x8b); |
| shuffle_16x8b = _mm_setr_epi8(10, 3, 9, 2, |
| 9, 2, 8, 1, |
| 8, 1, 0, 0, |
| 0, 0, 0, 0); |
| pred8_16x8b = _mm_shuffle_epi8(temp1_16x8b, shuffle_16x8b); |
| sad_8x16b = _mm_sad_epu8(src_16x8b, pred8_16x8b); |
| |
| sad[HORZ_U_I4x4] = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| cost[HORZ_U_I4x4] = sad[HORZ_U_I4x4] + ((u4_predictd_mode == HORZ_U_I4x4) ? u4_lambda: lambda4); |
| } |
| |
| min_cost = MIN3(MIN3(cost[0], cost[1], cost[2]), |
| MIN3(cost[3], cost[4], cost[5]), |
| MIN3(cost[6], cost[7], cost[8])); |
| } |
| else |
| { /*Only first three modes valid*/ |
| min_cost = MIN3(cost[0], cost[1], cost[2]); |
| } |
| |
| *pu4_sadmin = min_cost; |
| |
| if(min_cost == cost[0]) |
| { |
| *u4_intra_mode = VERT_I4x4; |
| } |
| else if(min_cost == cost[1]) |
| { |
| *u4_intra_mode = HORZ_I4x4; |
| pred0_16x8b = pred1_16x8b; |
| } |
| else if(min_cost == cost[2]) |
| { |
| *u4_intra_mode = DC_I4x4; |
| pred0_16x8b = pred2_16x8b; |
| } |
| else if(min_cost == cost[3]) |
| { |
| *u4_intra_mode = DIAG_DL_I4x4; |
| pred0_16x8b = pred3_16x8b; |
| } |
| else if(min_cost == cost[4]) |
| { |
| *u4_intra_mode = DIAG_DR_I4x4; |
| pred0_16x8b = pred4_16x8b; |
| } |
| else if(min_cost == cost[5]) |
| { |
| *u4_intra_mode = VERT_R_I4x4; |
| pred0_16x8b = pred5_16x8b; |
| } |
| else if(min_cost == cost[6]) |
| { |
| *u4_intra_mode = HORZ_D_I4x4; |
| pred0_16x8b = pred6_16x8b; |
| } |
| else if(min_cost == cost[7]) |
| { |
| *u4_intra_mode = VERT_L_I4x4; |
| pred0_16x8b = pred7_16x8b; |
| } |
| else if(min_cost == cost[8]) |
| { |
| *u4_intra_mode = HORZ_U_I4x4; |
| pred0_16x8b = pred8_16x8b; |
| } |
| |
| mask_low_32b = _mm_set1_epi8(0xff); |
| mask_low_32b = _mm_srli_si128(mask_low_32b, 12); |
| |
| _mm_maskmoveu_si128(pred0_16x8b, mask_low_32b, (char*)pu1_dst); |
| pred0_16x8b = _mm_srli_si128(pred0_16x8b, 4); |
| _mm_maskmoveu_si128(pred0_16x8b, mask_low_32b, (char*)(pu1_dst + dst_strd)); |
| pred0_16x8b = _mm_srli_si128(pred0_16x8b, 4); |
| _mm_maskmoveu_si128(pred0_16x8b, mask_low_32b, (char*)(pu1_dst + dst_strd2)); |
| pred0_16x8b = _mm_srli_si128(pred0_16x8b, 4); |
| _mm_maskmoveu_si128(pred0_16x8b, mask_low_32b, (char*)(pu1_dst + dst_strd3)); |
| |
| } |
| |
| /** |
| ****************************************************************************** |
| * |
| * @brief |
| * Evaluate best intra chroma mode (among VERT, HORZ and DC) and do the prediction. |
| * |
| * @par Description |
| * This function evaluates first three intra chroma modes and compute corresponding sad |
| * and return the buffer predicted with best mode. |
| * |
| * @param[in] pu1_src |
| * UWORD8 pointer to the source |
| * |
| ** @param[in] pu1_ngbr_pels |
| * UWORD8 pointer to neighbouring pels |
| * |
| * @param[out] pu1_dst |
| * UWORD8 pointer to the destination |
| * |
| * @param[in] src_strd |
| * integer source stride |
| * |
| * @param[in] dst_strd |
| * integer destination stride |
| * |
| * @param[in] u4_n_avblty |
| * availability of neighbouring pixels |
| * |
| * @param[in] u4_intra_mode |
| * pointer to the variable in which best mode is returned |
| * |
| * @param[in] pu4_sadmin |
| * pointer to the variable in which minimum sad is returned |
| * |
| * @param[in] u4_valid_intra_modes |
| * says what all modes are valid |
| * |
| * @return |
| * none |
| * |
| ****************************************************************************** |
| */ |
| |
| void ih264e_evaluate_intra_chroma_modes_ssse3(UWORD8 *pu1_src, |
| UWORD8 *pu1_ngbr_pels, |
| UWORD8 *pu1_dst, |
| UWORD32 src_strd, |
| UWORD32 dst_strd, |
| WORD32 u4_n_avblty, |
| UWORD32 *u4_intra_mode, |
| WORD32 *pu4_sadmin, |
| UWORD32 u4_valid_intra_modes) |
| { |
| WORD32 left, top; |
| WORD32 sad_vert = INT_MAX, sad_horz = INT_MAX, sad_dc = INT_MAX, min_sad; |
| |
| __m128i src1_16x8b, src2_16x8b, src3_16x8b, src4_16x8b; |
| __m128i src5_16x8b, src6_16x8b, src7_16x8b, src8_16x8b; |
| |
| __m128i top_16x8b, left_16x8b; |
| __m128i pred1_16x8b, pred2_16x8b; |
| __m128i tmp1_8x16b, tmp2_8x16b, sad_8x16b; |
| |
| left = (u4_n_avblty & LEFT_MB_AVAILABLE_MASK); |
| top = (u4_n_avblty & TOP_MB_AVAILABLE_MASK) >> 2; |
| |
| //Loading source |
| { |
| src1_16x8b = _mm_loadu_si128((__m128i *)pu1_src); |
| pu1_src += src_strd; |
| src2_16x8b = _mm_loadu_si128((__m128i *)pu1_src); |
| pu1_src += src_strd; |
| src3_16x8b = _mm_loadu_si128((__m128i *)pu1_src); |
| pu1_src += src_strd; |
| src4_16x8b = _mm_loadu_si128((__m128i *)pu1_src); |
| pu1_src += src_strd; |
| src5_16x8b = _mm_loadu_si128((__m128i *)pu1_src); |
| pu1_src += src_strd; |
| src6_16x8b = _mm_loadu_si128((__m128i *)pu1_src); |
| pu1_src += src_strd; |
| src7_16x8b = _mm_loadu_si128((__m128i *)pu1_src); |
| pu1_src += src_strd; |
| src8_16x8b = _mm_loadu_si128((__m128i *)pu1_src); |
| } |
| |
| if(left) |
| { |
| left_16x8b = _mm_loadu_si128((__m128i *)pu1_ngbr_pels); |
| |
| if(u4_valid_intra_modes & 02) //If HORZ mode is valid |
| { |
| __m128i left_tmp_16x8b, left_sh_16x8b; |
| __m128i const_14_15_16x8b; |
| |
| const_14_15_16x8b = _mm_set1_epi16(0x0f0e); |
| left_sh_16x8b = _mm_slli_si128(left_16x8b, 2); |
| |
| pred1_16x8b = _mm_shuffle_epi8(left_16x8b, const_14_15_16x8b); //row 1 |
| pred2_16x8b = _mm_shuffle_epi8(left_sh_16x8b, const_14_15_16x8b); //row 2 |
| tmp1_8x16b = _mm_sad_epu8(src1_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src2_16x8b, pred2_16x8b); |
| |
| left_tmp_16x8b = _mm_slli_si128(left_16x8b, 4); |
| left_sh_16x8b = _mm_slli_si128(left_sh_16x8b, 4); |
| sad_8x16b = _mm_add_epi16(tmp1_8x16b, tmp2_8x16b); |
| |
| pred1_16x8b = _mm_shuffle_epi8(left_tmp_16x8b, const_14_15_16x8b); //row 3 |
| pred2_16x8b = _mm_shuffle_epi8(left_sh_16x8b, const_14_15_16x8b); //row 4 |
| tmp1_8x16b = _mm_sad_epu8(src3_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src4_16x8b, pred2_16x8b); |
| |
| left_tmp_16x8b = _mm_slli_si128(left_tmp_16x8b, 4); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| left_sh_16x8b = _mm_slli_si128(left_sh_16x8b, 4); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| pred1_16x8b = _mm_shuffle_epi8(left_tmp_16x8b, const_14_15_16x8b); //row 5 |
| pred2_16x8b = _mm_shuffle_epi8(left_sh_16x8b, const_14_15_16x8b); //row 6 |
| tmp1_8x16b = _mm_sad_epu8(src5_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src6_16x8b, pred2_16x8b); |
| |
| left_tmp_16x8b = _mm_slli_si128(left_tmp_16x8b, 4); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| left_sh_16x8b = _mm_slli_si128(left_sh_16x8b, 4); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| pred1_16x8b = _mm_shuffle_epi8(left_tmp_16x8b, const_14_15_16x8b); //row 7 |
| pred2_16x8b = _mm_shuffle_epi8(left_sh_16x8b, const_14_15_16x8b); //row 8 |
| tmp1_8x16b = _mm_sad_epu8(src7_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src8_16x8b, pred2_16x8b); |
| |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| sad_horz = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| } |
| } |
| |
| if(top) |
| { |
| UWORD8 *pu1_top; |
| |
| pu1_top = pu1_ngbr_pels + 2 * BLK8x8SIZE + 2; |
| top_16x8b = _mm_loadu_si128((__m128i *)pu1_top); |
| |
| if(u4_valid_intra_modes & 04) //If VERT mode is valid |
| { |
| tmp1_8x16b = _mm_sad_epu8(src1_16x8b, top_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src2_16x8b, top_16x8b); |
| sad_8x16b = _mm_add_epi16(tmp1_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src3_16x8b, top_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src4_16x8b, top_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src5_16x8b, top_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src6_16x8b, top_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src7_16x8b, top_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src8_16x8b, top_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| sad_vert = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| } |
| } |
| |
| if(u4_valid_intra_modes & 01) //If DC mode is valid |
| { |
| if(left && top) |
| { |
| WORD32 left_up_u, left_down_u, left_up_v, left_down_v; |
| WORD32 top_left_u, top_right_u, top_left_v, top_right_v; |
| WORD32 dc_1u, dc_1v, dc_2u, dc_2v; |
| |
| __m128i val_sh_16x8b; |
| __m128i intrlv_mask_8x16b, zero_vector; |
| |
| intrlv_mask_8x16b = _mm_set1_epi16(0x00ff); |
| zero_vector = _mm_setzero_si128(); |
| |
| val_sh_16x8b = _mm_srli_si128(left_16x8b, 1); |
| |
| tmp1_8x16b = _mm_and_si128(intrlv_mask_8x16b, left_16x8b); |
| tmp2_8x16b = _mm_and_si128(intrlv_mask_8x16b, val_sh_16x8b); |
| tmp1_8x16b = _mm_sad_epu8(zero_vector, tmp1_8x16b); |
| tmp2_8x16b = _mm_sad_epu8(zero_vector, tmp2_8x16b); |
| |
| left_up_u = _mm_extract_epi16(tmp1_8x16b, 4); |
| left_up_v = _mm_extract_epi16(tmp2_8x16b, 4); |
| left_down_u = _mm_extract_epi16(tmp1_8x16b, 0); |
| left_down_v = _mm_extract_epi16(tmp2_8x16b, 0); |
| |
| val_sh_16x8b = _mm_srli_si128(top_16x8b, 1); |
| |
| tmp1_8x16b = _mm_and_si128(intrlv_mask_8x16b, top_16x8b); |
| tmp2_8x16b = _mm_and_si128(intrlv_mask_8x16b, val_sh_16x8b); |
| tmp1_8x16b = _mm_sad_epu8(zero_vector, tmp1_8x16b); |
| tmp2_8x16b = _mm_sad_epu8(zero_vector, tmp2_8x16b); |
| |
| top_left_u = _mm_extract_epi16(tmp1_8x16b, 0); |
| top_left_v = _mm_extract_epi16(tmp2_8x16b, 0); |
| top_right_u = _mm_extract_epi16(tmp1_8x16b, 4); |
| top_right_v = _mm_extract_epi16(tmp2_8x16b, 4); |
| |
| // First four rows |
| dc_1u = (left_up_u + top_left_u + 4) >> 3; |
| dc_1v = (left_up_v + top_left_v + 4) >> 3; |
| dc_2u = (top_right_u + 2) >> 2; |
| dc_2v = (top_right_v + 2) >> 2; |
| |
| pred1_16x8b = _mm_setr_epi8(dc_1u, dc_1v, dc_1u, dc_1v, dc_1u, dc_1v, dc_1u, dc_1v, |
| dc_2u, dc_2v, dc_2u, dc_2v, dc_2u, dc_2v, dc_2u, dc_2v); |
| |
| tmp1_8x16b = _mm_sad_epu8(src1_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src2_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(tmp1_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src3_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src4_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| // Second four rows |
| dc_1u = (left_down_u + 2) >> 2; |
| dc_1v = (left_down_v + 2) >> 2; |
| dc_2u = (left_down_u + top_right_u + 4) >> 3; |
| dc_2v = (left_down_v + top_right_v + 4) >> 3; |
| |
| pred2_16x8b = _mm_setr_epi8(dc_1u, dc_1v, dc_1u, dc_1v, dc_1u, dc_1v, dc_1u, dc_1v, |
| dc_2u, dc_2v, dc_2u, dc_2v, dc_2u, dc_2v, dc_2u, dc_2v); |
| |
| tmp1_8x16b = _mm_sad_epu8(src5_16x8b, pred2_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src6_16x8b, pred2_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src7_16x8b, pred2_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src8_16x8b, pred2_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| sad_dc = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| } |
| else if(left) |
| { |
| WORD32 left_up_u, left_down_u, left_up_v, left_down_v; |
| WORD32 dc_u, dc_v; |
| |
| __m128i left_sh_16x8b; |
| __m128i intrlv_mask_8x16b, zero_vector; |
| |
| intrlv_mask_8x16b = _mm_set1_epi16(0x00ff); |
| zero_vector = _mm_setzero_si128(); |
| |
| left_sh_16x8b = _mm_srli_si128(left_16x8b, 1); |
| |
| tmp1_8x16b = _mm_and_si128(intrlv_mask_8x16b, left_16x8b); |
| tmp2_8x16b = _mm_and_si128(intrlv_mask_8x16b, left_sh_16x8b); |
| tmp1_8x16b = _mm_sad_epu8(zero_vector, tmp1_8x16b); |
| tmp2_8x16b = _mm_sad_epu8(zero_vector, tmp2_8x16b); |
| |
| left_up_u = _mm_extract_epi16(tmp1_8x16b, 4); |
| left_up_v = _mm_extract_epi16(tmp2_8x16b, 4); |
| left_down_u = _mm_extract_epi16(tmp1_8x16b, 0); |
| left_down_v = _mm_extract_epi16(tmp2_8x16b, 0); |
| |
| // First four rows |
| dc_u = (left_up_u + 2) >> 2; |
| dc_v = (left_up_v + 2) >> 2; |
| |
| pred1_16x8b = _mm_set1_epi16(dc_u | (dc_v << 8)); |
| |
| tmp1_8x16b = _mm_sad_epu8(src1_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src2_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(tmp1_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src3_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src4_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| // Second four rows |
| dc_u = (left_down_u + 2) >> 2; |
| dc_v = (left_down_v + 2) >> 2; |
| |
| pred2_16x8b = _mm_set1_epi16(dc_u | (dc_v << 8)); |
| |
| tmp1_8x16b = _mm_sad_epu8(src5_16x8b, pred2_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src6_16x8b, pred2_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src7_16x8b, pred2_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src8_16x8b, pred2_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| sad_dc = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| } |
| else if(top) |
| { |
| WORD32 top_left_u, top_right_u, top_left_v, top_right_v; |
| WORD32 dc_1u, dc_1v, dc_2u, dc_2v; |
| |
| __m128i top_sh_16x8b; |
| __m128i intrlv_mask_8x16b, zero_vector; |
| |
| intrlv_mask_8x16b = _mm_set1_epi16(0x00ff); |
| zero_vector = _mm_setzero_si128(); |
| |
| top_sh_16x8b = _mm_srli_si128(top_16x8b, 1); |
| |
| tmp1_8x16b = _mm_and_si128(intrlv_mask_8x16b, top_16x8b); |
| tmp2_8x16b = _mm_and_si128(intrlv_mask_8x16b, top_sh_16x8b); |
| tmp1_8x16b = _mm_sad_epu8(zero_vector, tmp1_8x16b); |
| tmp2_8x16b = _mm_sad_epu8(zero_vector, tmp2_8x16b); |
| |
| top_left_u = _mm_extract_epi16(tmp1_8x16b, 0); |
| top_left_v = _mm_extract_epi16(tmp2_8x16b, 0); |
| top_right_u = _mm_extract_epi16(tmp1_8x16b, 4); |
| top_right_v = _mm_extract_epi16(tmp2_8x16b, 4); |
| |
| dc_1u = (top_left_u + 2) >> 2; |
| dc_1v = (top_left_v + 2) >> 2; |
| dc_2u = (top_right_u + 2) >> 2; |
| dc_2v = (top_right_v + 2) >> 2; |
| |
| pred1_16x8b = _mm_setr_epi8(dc_1u, dc_1v, dc_1u, dc_1v, dc_1u, dc_1v, dc_1u, dc_1v, |
| dc_2u, dc_2v, dc_2u, dc_2v, dc_2u, dc_2v, dc_2u, dc_2v); |
| |
| tmp1_8x16b = _mm_sad_epu8(src1_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src2_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(tmp1_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src3_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src4_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src5_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src6_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src7_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src8_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| sad_dc = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| } |
| else |
| { |
| pred1_16x8b = _mm_set1_epi8(128); |
| |
| tmp1_8x16b = _mm_sad_epu8(src1_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src2_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(tmp1_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src3_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src4_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src5_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src6_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| tmp1_8x16b = _mm_sad_epu8(src7_16x8b, pred1_16x8b); |
| tmp2_8x16b = _mm_sad_epu8(src8_16x8b, pred1_16x8b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp1_8x16b); |
| sad_8x16b = _mm_add_epi16(sad_8x16b, tmp2_8x16b); |
| |
| sad_dc = _mm_extract_epi16(sad_8x16b, 0) + _mm_extract_epi16(sad_8x16b, 4); |
| } |
| } |
| |
| min_sad = MIN3(sad_horz, sad_vert, sad_dc); |
| |
| /* Finding minimum SAD and doing corresponding prediction*/ |
| if(min_sad < *pu4_sadmin) |
| { |
| *pu4_sadmin = min_sad; |
| |
| if(min_sad == sad_dc) |
| { |
| *u4_intra_mode = DC_CH_I8x8; |
| |
| if(!left) |
| pred2_16x8b = pred1_16x8b; |
| |
| _mm_storeu_si128((__m128i *)pu1_dst, pred1_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred1_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred1_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred1_16x8b); |
| pu1_dst += dst_strd; |
| |
| _mm_storeu_si128((__m128i *)pu1_dst, pred2_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred2_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred2_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred2_16x8b); |
| } |
| else if(min_sad == sad_horz) |
| { |
| __m128i left_sh_16x8b, const_14_15_16x8b; |
| |
| *u4_intra_mode = HORZ_CH_I8x8; |
| |
| const_14_15_16x8b = _mm_set1_epi16(0x0f0e); |
| |
| left_sh_16x8b = _mm_slli_si128(left_16x8b, 2); |
| pred1_16x8b = _mm_shuffle_epi8(left_16x8b, const_14_15_16x8b); //row 1 |
| pred2_16x8b = _mm_shuffle_epi8(left_sh_16x8b, const_14_15_16x8b); //row 2 |
| |
| _mm_storeu_si128((__m128i *)pu1_dst, pred1_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred2_16x8b); |
| |
| left_16x8b = _mm_slli_si128(left_16x8b, 4); |
| left_sh_16x8b = _mm_slli_si128(left_sh_16x8b, 4); |
| pred1_16x8b = _mm_shuffle_epi8(left_16x8b, const_14_15_16x8b); //row 3 |
| pred2_16x8b = _mm_shuffle_epi8(left_sh_16x8b, const_14_15_16x8b); //row 4 |
| |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred1_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred2_16x8b); |
| |
| left_16x8b = _mm_slli_si128(left_16x8b, 4); |
| left_sh_16x8b = _mm_slli_si128(left_sh_16x8b, 4); |
| pred1_16x8b = _mm_shuffle_epi8(left_16x8b, const_14_15_16x8b); //row 5 |
| pred2_16x8b = _mm_shuffle_epi8(left_sh_16x8b, const_14_15_16x8b); //row 6 |
| |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred1_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred2_16x8b); |
| |
| left_16x8b = _mm_slli_si128(left_16x8b, 4); |
| left_sh_16x8b = _mm_slli_si128(left_sh_16x8b, 4); |
| pred1_16x8b = _mm_shuffle_epi8(left_16x8b, const_14_15_16x8b); //row 7 |
| pred2_16x8b = _mm_shuffle_epi8(left_sh_16x8b, const_14_15_16x8b); //row 8 |
| |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred1_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, pred2_16x8b); |
| } |
| else |
| { |
| *u4_intra_mode = VERT_CH_I8x8; |
| |
| _mm_storeu_si128((__m128i *)pu1_dst, top_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, top_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, top_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, top_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, top_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, top_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, top_16x8b); |
| pu1_dst += dst_strd; |
| _mm_storeu_si128((__m128i *)pu1_dst, top_16x8b); |
| } |
| } |
| } |
