| /* |
| * Copyright (c) 2016, Alliance for Open Media. All rights reserved |
| * |
| * This source code is subject to the terms of the BSD 2 Clause License and |
| * the Alliance for Open Media Patent License 1.0. If the BSD 2 Clause License |
| * was not distributed with this source code in the LICENSE file, you can |
| * obtain it at www.aomedia.org/license/software. If the Alliance for Open |
| * Media Patent License 1.0 was not distributed with this source code in the |
| * PATENTS file, you can obtain it at www.aomedia.org/license/patent. |
| */ |
| |
| #include <arm_neon.h> |
| |
| #include <math.h> |
| |
| #include "aom_dsp/arm/mem_neon.h" |
| #include "aom_mem/aom_mem.h" |
| |
| #include "av1/common/quant_common.h" |
| #include "av1/common/seg_common.h" |
| |
| #include "av1/encoder/av1_quantize.h" |
| #include "av1/encoder/encoder.h" |
| #include "av1/encoder/rd.h" |
| |
| void av1_quantize_fp_neon(const tran_low_t *coeff_ptr, intptr_t count, |
| const int16_t *zbin_ptr, const int16_t *round_ptr, |
| const int16_t *quant_ptr, |
| const int16_t *quant_shift_ptr, |
| tran_low_t *qcoeff_ptr, tran_low_t *dqcoeff_ptr, |
| const int16_t *dequant_ptr, uint16_t *eob_ptr, |
| const int16_t *scan, const int16_t *iscan) { |
| // TODO(jingning) Decide the need of these arguments after the |
| // quantization process is completed. |
| (void)zbin_ptr; |
| (void)quant_shift_ptr; |
| (void)scan; |
| |
| // Quantization pass: All coefficients with index >= zero_flag are |
| // skippable. Note: zero_flag can be zero. |
| int i; |
| const int16x8_t v_zero = vdupq_n_s16(0); |
| const int16x8_t v_one = vdupq_n_s16(1); |
| int16x8_t v_eobmax_76543210 = vdupq_n_s16(-1); |
| int16x8_t v_round = vmovq_n_s16(round_ptr[1]); |
| int16x8_t v_quant = vmovq_n_s16(quant_ptr[1]); |
| int16x8_t v_dequant = vmovq_n_s16(dequant_ptr[1]); |
| // adjust for dc |
| v_round = vsetq_lane_s16(round_ptr[0], v_round, 0); |
| v_quant = vsetq_lane_s16(quant_ptr[0], v_quant, 0); |
| v_dequant = vsetq_lane_s16(dequant_ptr[0], v_dequant, 0); |
| // process dc and the first seven ac coeffs |
| { |
| const int16x8_t v_iscan = vld1q_s16(&iscan[0]); |
| const int16x8_t v_coeff = load_tran_low_to_s16q(&coeff_ptr[0]); |
| const int16x8_t v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| const int16x8_t v_abs = vabsq_s16(v_coeff); |
| const int16x8_t v_tmp = vqaddq_s16(v_abs, v_round); |
| const int32x4_t v_tmp_lo = |
| vmull_s16(vget_low_s16(v_tmp), vget_low_s16(v_quant)); |
| const int32x4_t v_tmp_hi = |
| vmull_s16(vget_high_s16(v_tmp), vget_high_s16(v_quant)); |
| const int16x8_t v_tmp2 = |
| vcombine_s16(vshrn_n_s32(v_tmp_lo, 16), vshrn_n_s32(v_tmp_hi, 16)); |
| const uint16x8_t v_nz_mask = vceqq_s16(v_tmp2, v_zero); |
| const int16x8_t v_iscan_plus1 = vaddq_s16(v_iscan, v_one); |
| const int16x8_t v_nz_iscan = vbslq_s16(v_nz_mask, v_zero, v_iscan_plus1); |
| const int16x8_t v_qcoeff_a = veorq_s16(v_tmp2, v_coeff_sign); |
| const int16x8_t v_qcoeff = vsubq_s16(v_qcoeff_a, v_coeff_sign); |
| const int16x8_t v_dqcoeff = vmulq_s16(v_qcoeff, v_dequant); |
| v_eobmax_76543210 = vmaxq_s16(v_eobmax_76543210, v_nz_iscan); |
| store_s16q_to_tran_low(&qcoeff_ptr[0], v_qcoeff); |
| store_s16q_to_tran_low(&dqcoeff_ptr[0], v_dqcoeff); |
| v_round = vmovq_n_s16(round_ptr[1]); |
| v_quant = vmovq_n_s16(quant_ptr[1]); |
| v_dequant = vmovq_n_s16(dequant_ptr[1]); |
| } |
| // now process the rest of the ac coeffs |
| for (i = 8; i < count; i += 8) { |
| const int16x8_t v_iscan = vld1q_s16(&iscan[i]); |
| const int16x8_t v_coeff = load_tran_low_to_s16q(&coeff_ptr[i]); |
| const int16x8_t v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| const int16x8_t v_abs = vabsq_s16(v_coeff); |
| const int16x8_t v_tmp = vqaddq_s16(v_abs, v_round); |
| const int32x4_t v_tmp_lo = |
| vmull_s16(vget_low_s16(v_tmp), vget_low_s16(v_quant)); |
| const int32x4_t v_tmp_hi = |
| vmull_s16(vget_high_s16(v_tmp), vget_high_s16(v_quant)); |
| const int16x8_t v_tmp2 = |
| vcombine_s16(vshrn_n_s32(v_tmp_lo, 16), vshrn_n_s32(v_tmp_hi, 16)); |
| const uint16x8_t v_nz_mask = vceqq_s16(v_tmp2, v_zero); |
| const int16x8_t v_iscan_plus1 = vaddq_s16(v_iscan, v_one); |
| const int16x8_t v_nz_iscan = vbslq_s16(v_nz_mask, v_zero, v_iscan_plus1); |
| const int16x8_t v_qcoeff_a = veorq_s16(v_tmp2, v_coeff_sign); |
| const int16x8_t v_qcoeff = vsubq_s16(v_qcoeff_a, v_coeff_sign); |
| const int16x8_t v_dqcoeff = vmulq_s16(v_qcoeff, v_dequant); |
| v_eobmax_76543210 = vmaxq_s16(v_eobmax_76543210, v_nz_iscan); |
| store_s16q_to_tran_low(&qcoeff_ptr[i], v_qcoeff); |
| store_s16q_to_tran_low(&dqcoeff_ptr[i], v_dqcoeff); |
| } |
| #ifdef __aarch64__ |
| *eob_ptr = vmaxvq_s16(v_eobmax_76543210); |
| #else |
| { |
| const int16x4_t v_eobmax_3210 = vmax_s16(vget_low_s16(v_eobmax_76543210), |
| vget_high_s16(v_eobmax_76543210)); |
| const int64x1_t v_eobmax_xx32 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_3210), 32); |
| const int16x4_t v_eobmax_tmp = |
| vmax_s16(v_eobmax_3210, vreinterpret_s16_s64(v_eobmax_xx32)); |
| const int64x1_t v_eobmax_xxx3 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_tmp), 16); |
| const int16x4_t v_eobmax_final = |
| vmax_s16(v_eobmax_tmp, vreinterpret_s16_s64(v_eobmax_xxx3)); |
| |
| *eob_ptr = (uint16_t)vget_lane_s16(v_eobmax_final, 0); |
| } |
| #endif // __aarch64__ |
| } |
| |
| static INLINE void calculate_dqcoeff_lp_and_store(const int16x8_t qcoeff, |
| const int16x8_t dequant, |
| int16_t *dqcoeff) { |
| const int32x4_t dqcoeff_0 = |
| vmull_s16(vget_low_s16(qcoeff), vget_low_s16(dequant)); |
| const int32x4_t dqcoeff_1 = |
| vmull_s16(vget_high_s16(qcoeff), vget_high_s16(dequant)); |
| |
| vst1q_s16(dqcoeff, vcombine_s16(vmovn_s32(dqcoeff_0), vmovn_s32(dqcoeff_1))); |
| } |
| |
| void av1_quantize_lp_neon(const int16_t *coeff_ptr, intptr_t n_coeffs, |
| const int16_t *round_ptr, const int16_t *quant_ptr, |
| int16_t *qcoeff_ptr, int16_t *dqcoeff_ptr, |
| const int16_t *dequant_ptr, uint16_t *eob_ptr, |
| const int16_t *scan, const int16_t *iscan) { |
| (void)scan; |
| // Quantization pass: All coefficients with index >= zero_flag are |
| // skippable. Note: zero_flag can be zero. |
| const int16x8_t v_zero = vdupq_n_s16(0); |
| const int16x8_t v_one = vdupq_n_s16(1); |
| int16x8_t v_eobmax_76543210 = vdupq_n_s16(-1); |
| int16x8_t v_round = vmovq_n_s16(round_ptr[1]); |
| int16x8_t v_quant = vmovq_n_s16(quant_ptr[1]); |
| int16x8_t v_dequant = vmovq_n_s16(dequant_ptr[1]); |
| |
| // adjust for dc |
| v_round = vsetq_lane_s16(round_ptr[0], v_round, 0); |
| v_quant = vsetq_lane_s16(quant_ptr[0], v_quant, 0); |
| v_dequant = vsetq_lane_s16(dequant_ptr[0], v_dequant, 0); |
| // process dc and the first seven ac coeffs |
| { |
| const int16x8_t v_iscan = vld1q_s16(&iscan[0]); |
| const int16x8_t v_coeff = vld1q_s16(coeff_ptr); |
| const int16x8_t v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| const int16x8_t v_abs = vabsq_s16(v_coeff); |
| const int16x8_t v_tmp = vqaddq_s16(v_abs, v_round); |
| const int32x4_t v_tmp_lo = |
| vmull_s16(vget_low_s16(v_tmp), vget_low_s16(v_quant)); |
| const int32x4_t v_tmp_hi = |
| vmull_s16(vget_high_s16(v_tmp), vget_high_s16(v_quant)); |
| const int16x8_t v_tmp2 = |
| vcombine_s16(vshrn_n_s32(v_tmp_lo, 16), vshrn_n_s32(v_tmp_hi, 16)); |
| const uint16x8_t v_nz_mask = vceqq_s16(v_tmp2, v_zero); |
| const int16x8_t v_iscan_plus1 = vaddq_s16(v_iscan, v_one); |
| const int16x8_t v_nz_iscan = vbslq_s16(v_nz_mask, v_zero, v_iscan_plus1); |
| const int16x8_t v_qcoeff_a = veorq_s16(v_tmp2, v_coeff_sign); |
| const int16x8_t v_qcoeff = vsubq_s16(v_qcoeff_a, v_coeff_sign); |
| calculate_dqcoeff_lp_and_store(v_qcoeff, v_dequant, dqcoeff_ptr); |
| v_eobmax_76543210 = vmaxq_s16(v_eobmax_76543210, v_nz_iscan); |
| vst1q_s16(qcoeff_ptr, v_qcoeff); |
| v_round = vmovq_n_s16(round_ptr[1]); |
| v_quant = vmovq_n_s16(quant_ptr[1]); |
| v_dequant = vmovq_n_s16(dequant_ptr[1]); |
| } |
| // now process the rest of the ac coeffs |
| for (int i = 8; i < n_coeffs; i += 8) { |
| const int16x8_t v_iscan = vld1q_s16(&iscan[i]); |
| const int16x8_t v_coeff = vld1q_s16(coeff_ptr + i); |
| const int16x8_t v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| const int16x8_t v_abs = vabsq_s16(v_coeff); |
| const int16x8_t v_tmp = vqaddq_s16(v_abs, v_round); |
| const int32x4_t v_tmp_lo = |
| vmull_s16(vget_low_s16(v_tmp), vget_low_s16(v_quant)); |
| const int32x4_t v_tmp_hi = |
| vmull_s16(vget_high_s16(v_tmp), vget_high_s16(v_quant)); |
| const int16x8_t v_tmp2 = |
| vcombine_s16(vshrn_n_s32(v_tmp_lo, 16), vshrn_n_s32(v_tmp_hi, 16)); |
| const uint16x8_t v_nz_mask = vceqq_s16(v_tmp2, v_zero); |
| const int16x8_t v_iscan_plus1 = vaddq_s16(v_iscan, v_one); |
| const int16x8_t v_nz_iscan = vbslq_s16(v_nz_mask, v_zero, v_iscan_plus1); |
| const int16x8_t v_qcoeff_a = veorq_s16(v_tmp2, v_coeff_sign); |
| const int16x8_t v_qcoeff = vsubq_s16(v_qcoeff_a, v_coeff_sign); |
| calculate_dqcoeff_lp_and_store(v_qcoeff, v_dequant, dqcoeff_ptr + i); |
| v_eobmax_76543210 = vmaxq_s16(v_eobmax_76543210, v_nz_iscan); |
| vst1q_s16(qcoeff_ptr + i, v_qcoeff); |
| } |
| #ifdef __aarch64__ |
| *eob_ptr = vmaxvq_s16(v_eobmax_76543210); |
| #else |
| { |
| const int16x4_t v_eobmax_3210 = vmax_s16(vget_low_s16(v_eobmax_76543210), |
| vget_high_s16(v_eobmax_76543210)); |
| const int64x1_t v_eobmax_xx32 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_3210), 32); |
| const int16x4_t v_eobmax_tmp = |
| vmax_s16(v_eobmax_3210, vreinterpret_s16_s64(v_eobmax_xx32)); |
| const int64x1_t v_eobmax_xxx3 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_tmp), 16); |
| const int16x4_t v_eobmax_final = |
| vmax_s16(v_eobmax_tmp, vreinterpret_s16_s64(v_eobmax_xxx3)); |
| |
| *eob_ptr = (uint16_t)vget_lane_s16(v_eobmax_final, 0); |
| } |
| #endif // __aarch64__ |
| } |
| |
| void av1_quantize_fp_32x32_neon(const tran_low_t *coeff_ptr, intptr_t n_coeffs, |
| const int16_t *zbin_ptr, |
| const int16_t *round_ptr, |
| const int16_t *quant_ptr, |
| const int16_t *quant_shift_ptr, |
| tran_low_t *qcoeff_ptr, tran_low_t *dqcoeff_ptr, |
| const int16_t *dequant_ptr, uint16_t *eob_ptr, |
| const int16_t *scan, const int16_t *iscan) { |
| const int log_scale = 1; |
| const int rounding[2] = { ROUND_POWER_OF_TWO(round_ptr[0], log_scale), |
| ROUND_POWER_OF_TWO(round_ptr[1], log_scale) }; |
| |
| (void)zbin_ptr; |
| (void)quant_shift_ptr; |
| (void)scan; |
| |
| memset(qcoeff_ptr, 0, n_coeffs * sizeof(*qcoeff_ptr)); |
| memset(dqcoeff_ptr, 0, n_coeffs * sizeof(*dqcoeff_ptr)); |
| |
| const int16x8_t zero = vdupq_n_s16(0); |
| int16x8_t v_eobmax_76543210 = vreinterpretq_s16_u16(vceqq_s16(zero, zero)); |
| int16x8_t round = vdupq_n_s16(rounding[1]); |
| int16x8_t quant = vdupq_n_s16(quant_ptr[1]); |
| int16x8_t dequant = vdupq_n_s16(dequant_ptr[1]); |
| dequant = vsetq_lane_s16(dequant_ptr[0], dequant, 0); |
| |
| int16x8_t coeff = load_tran_low_to_s16q(&coeff_ptr[0]); |
| |
| int16x8_t abs = vabsq_s16(coeff); |
| uint16x8_t check = vcgeq_s16(abs, vshrq_n_s16(dequant, 2)); |
| uint64_t nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(check)), 0); |
| if (nz_check) { |
| const int16x8_t coeff_sign = vshrq_n_s16(coeff, 15); |
| const int16x8_t v_iscan = vld1q_s16(&iscan[0]); |
| round = vsetq_lane_s16(rounding[0], round, 0); |
| quant = vsetq_lane_s16(quant_ptr[0], quant, 0); |
| |
| abs = vqaddq_s16(abs, round); |
| int16x8_t temp = vqdmulhq_s16(abs, quant); |
| int16x8_t qcoeff_temp = vsubq_s16(veorq_s16(temp, coeff_sign), coeff_sign); |
| abs = vreinterpretq_s16_u16( |
| vshrq_n_u16(vreinterpretq_u16_s16(vmulq_s16(temp, dequant)), 1)); |
| int16x8_t dqcoeff_temp = vsubq_s16(veorq_s16(abs, coeff_sign), coeff_sign); |
| |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(check, qcoeff_temp, load_tran_low_to_s16q(&qcoeff_ptr[0])); |
| store_s16q_to_tran_low(&qcoeff_ptr[0], coeff_nz_mask); |
| coeff_nz_mask = |
| vbslq_s16(check, dqcoeff_temp, load_tran_low_to_s16q(&dqcoeff_ptr[0])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[0], coeff_nz_mask); |
| |
| round = vsetq_lane_s16(rounding[1], round, 0); |
| quant = vsetq_lane_s16(quant_ptr[1], quant, 0); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(abs, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, check); |
| check = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(check, v_iscan, v_eobmax_76543210); |
| } |
| |
| dequant = vsetq_lane_s16(dequant_ptr[1], dequant, 0); |
| |
| for (int i = 8; i < n_coeffs; i += 8) { |
| coeff = load_tran_low_to_s16q(&coeff_ptr[i]); |
| abs = vabsq_s16(coeff); |
| check = vcgeq_s16(abs, vshrq_n_s16(dequant, 2)); |
| |
| nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(check)), 0); |
| if (nz_check) { |
| const int16x8_t coeff_sign = vshrq_n_s16(coeff, 15); |
| const int16x8_t v_iscan = vld1q_s16(&iscan[i]); |
| |
| abs = vqaddq_s16(abs, round); |
| int16x8_t temp = vqdmulhq_s16(abs, quant); |
| int16x8_t qcoeff_temp = |
| vsubq_s16(veorq_s16(temp, coeff_sign), coeff_sign); |
| abs = vreinterpretq_s16_u16( |
| vshrq_n_u16(vreinterpretq_u16_s16(vmulq_s16(temp, dequant)), 1)); |
| int16x8_t dqcoeff_temp = |
| vsubq_s16(veorq_s16(abs, coeff_sign), coeff_sign); |
| |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(check, qcoeff_temp, load_tran_low_to_s16q(&qcoeff_ptr[i])); |
| store_s16q_to_tran_low(&qcoeff_ptr[i], coeff_nz_mask); |
| coeff_nz_mask = vbslq_s16(check, dqcoeff_temp, |
| load_tran_low_to_s16q(&dqcoeff_ptr[i])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[i], coeff_nz_mask); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(abs, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, check); |
| check = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(check, v_iscan, v_eobmax_76543210); |
| } |
| } |
| #ifdef __aarch64__ |
| *eob_ptr = vmaxvq_s16(v_eobmax_76543210) + 1; |
| #else |
| { |
| const int16x4_t v_eobmax_3210 = vmax_s16(vget_low_s16(v_eobmax_76543210), |
| vget_high_s16(v_eobmax_76543210)); |
| const int64x1_t v_eobmax_xx32 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_3210), 32); |
| const int16x4_t v_eobmax_tmp = |
| vmax_s16(v_eobmax_3210, vreinterpret_s16_s64(v_eobmax_xx32)); |
| const int64x1_t v_eobmax_xxx3 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_tmp), 16); |
| const int16x4_t v_eobmax_final = |
| vmax_s16(v_eobmax_tmp, vreinterpret_s16_s64(v_eobmax_xxx3)); |
| |
| *eob_ptr = (uint16_t)vget_lane_s16(v_eobmax_final, 0) + 1; |
| } |
| #endif // __aarch64__ |
| } |
| |
| void av1_quantize_fp_64x64_neon(const tran_low_t *coeff_ptr, intptr_t n_coeffs, |
| const int16_t *zbin_ptr, |
| const int16_t *round_ptr, |
| const int16_t *quant_ptr, |
| const int16_t *quant_shift_ptr, |
| tran_low_t *qcoeff_ptr, tran_low_t *dqcoeff_ptr, |
| const int16_t *dequant_ptr, uint16_t *eob_ptr, |
| const int16_t *scan, const int16_t *iscan) { |
| const int log_scale = 2; |
| const int16x8_t v_log_scale = |
| vreinterpretq_s16_s64(vdupq_n_s64(0xFFFEFFFEFFFEFFFE)); |
| |
| const int rounding[2] = { ROUND_POWER_OF_TWO(round_ptr[0], log_scale), |
| ROUND_POWER_OF_TWO(round_ptr[1], log_scale) }; |
| |
| (void)zbin_ptr; |
| (void)quant_shift_ptr; |
| (void)scan; |
| |
| memset(qcoeff_ptr, 0, n_coeffs * sizeof(*qcoeff_ptr)); |
| memset(dqcoeff_ptr, 0, n_coeffs * sizeof(*dqcoeff_ptr)); |
| |
| const int16x8_t zero = vdupq_n_s16(0); |
| int16x8_t v_eobmax_76543210 = vreinterpretq_s16_u16(vceqq_s16(zero, zero)); |
| |
| int16x8_t round = vdupq_n_s16(rounding[1]); |
| int16x8_t quant = vdupq_n_s16(quant_ptr[1]); |
| int16x8_t dequant = vdupq_n_s16(dequant_ptr[1]); |
| dequant = vsetq_lane_s16(dequant_ptr[0], dequant, 0); |
| |
| int16x8_t coeff = load_tran_low_to_s16q(&coeff_ptr[0]); |
| int16x8_t abs = vabsq_s16(coeff); |
| uint16x8_t check = vcgeq_u16(vshlq_n_u16(vreinterpretq_u16_s16(abs), 1), |
| vshrq_n_u16(vreinterpretq_u16_s16(dequant), 2)); |
| uint64_t nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(check)), 0); |
| if (nz_check) { |
| const int16x8_t coeff_sign = vshrq_n_s16(coeff, 15); |
| const int16x8_t v_iscan = vld1q_s16(&iscan[0]); |
| round = vsetq_lane_s16(rounding[0], round, 0); |
| quant = vsetq_lane_s16(quant_ptr[0], quant, 0); |
| abs = vqaddq_s16(abs, round); |
| int16x8_t temp = |
| vorrq_s16(vshlq_n_s16(vqdmulhq_s16(abs, quant), 1), |
| vreinterpretq_s16_u16(vshrq_n_u16( |
| vreinterpretq_u16_s16(vmulq_s16(abs, quant)), 14))); |
| int16x8_t qcoeff_temp = vsubq_s16(veorq_s16(temp, coeff_sign), coeff_sign); |
| |
| abs = vreinterpretq_s16_u16(vshlq_u16( |
| vreinterpretq_u16_s16(vmulq_s16(temp, dequant)), v_log_scale)); |
| abs = vorrq_s16(vshlq_n_s16(vqdmulhq_s16(temp, dequant), 13), abs); |
| int16x8_t dqcoeff_temp = vsubq_s16(veorq_s16(abs, coeff_sign), coeff_sign); |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(check, qcoeff_temp, load_tran_low_to_s16q(&qcoeff_ptr[0])); |
| store_s16q_to_tran_low(&qcoeff_ptr[0], coeff_nz_mask); |
| coeff_nz_mask = |
| vbslq_s16(check, dqcoeff_temp, load_tran_low_to_s16q(&dqcoeff_ptr[0])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[0], coeff_nz_mask); |
| |
| round = vsetq_lane_s16(rounding[1], round, 0); |
| quant = vsetq_lane_s16(quant_ptr[1], quant, 0); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(abs, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, check); |
| check = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(check, v_iscan, v_eobmax_76543210); |
| } |
| |
| dequant = vsetq_lane_s16(dequant_ptr[1], dequant, 0); |
| |
| for (int i = 8; i < n_coeffs; i += 8) { |
| coeff = load_tran_low_to_s16q(&coeff_ptr[i]); |
| abs = vabsq_s16(coeff); |
| check = vcgeq_u16(vshlq_n_u16(vreinterpretq_u16_s16(abs), 1), |
| vshrq_n_u16(vreinterpretq_u16_s16(dequant), 2)); |
| nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(check)), 0); |
| if (nz_check) { |
| const int16x8_t coeff_sign = vshrq_n_s16(coeff, 15); |
| const int16x8_t v_iscan = vld1q_s16(&iscan[i]); |
| abs = vqaddq_s16(abs, round); |
| int16x8_t temp = |
| vorrq_s16(vshlq_n_s16(vqdmulhq_s16(abs, quant), 1), |
| vreinterpretq_s16_u16(vshrq_n_u16( |
| vreinterpretq_u16_s16(vmulq_s16(abs, quant)), 14))); |
| |
| int16x8_t qcoeff_temp = |
| vsubq_s16(veorq_s16(temp, coeff_sign), coeff_sign); |
| |
| abs = vreinterpretq_s16_u16(vshlq_u16( |
| vreinterpretq_u16_s16(vmulq_s16(temp, dequant)), v_log_scale)); |
| abs = vorrq_s16(vshlq_n_s16(vqdmulhq_s16(temp, dequant), 13), abs); |
| |
| int16x8_t dqcoeff_temp = |
| vsubq_s16(veorq_s16(abs, coeff_sign), coeff_sign); |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(check, qcoeff_temp, load_tran_low_to_s16q(&qcoeff_ptr[i])); |
| store_s16q_to_tran_low(&qcoeff_ptr[i], coeff_nz_mask); |
| coeff_nz_mask = vbslq_s16(check, dqcoeff_temp, |
| load_tran_low_to_s16q(&dqcoeff_ptr[i])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[i], coeff_nz_mask); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(abs, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, check); |
| |
| check = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(check, v_iscan, v_eobmax_76543210); |
| } |
| } |
| #ifdef __aarch64__ |
| *eob_ptr = vmaxvq_s16(v_eobmax_76543210) + 1; |
| #else |
| { |
| const int16x4_t v_eobmax_3210 = vmax_s16(vget_low_s16(v_eobmax_76543210), |
| vget_high_s16(v_eobmax_76543210)); |
| const int64x1_t v_eobmax_xx32 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_3210), 32); |
| const int16x4_t v_eobmax_tmp = |
| vmax_s16(v_eobmax_3210, vreinterpret_s16_s64(v_eobmax_xx32)); |
| const int64x1_t v_eobmax_xxx3 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_tmp), 16); |
| const int16x4_t v_eobmax_final = |
| vmax_s16(v_eobmax_tmp, vreinterpret_s16_s64(v_eobmax_xxx3)); |
| |
| *eob_ptr = (uint16_t)vget_lane_s16(v_eobmax_final, 0) + 1; |
| } |
| #endif // __aarch64__ |
| } |
| |
| void aom_quantize_b_neon(const tran_low_t *coeff_ptr, intptr_t n_coeffs, |
| const int16_t *zbin_ptr, const int16_t *round_ptr, |
| const int16_t *quant_ptr, |
| const int16_t *quant_shift_ptr, tran_low_t *qcoeff_ptr, |
| tran_low_t *dqcoeff_ptr, const int16_t *dequant_ptr, |
| uint16_t *eob_ptr, const int16_t *scan, |
| const int16_t *iscan) { |
| (void)quant_shift_ptr; |
| (void)scan; |
| |
| const int zbins[2] = { zbin_ptr[0], zbin_ptr[1] }; |
| |
| memset(qcoeff_ptr, 0, n_coeffs * sizeof(*qcoeff_ptr)); |
| memset(dqcoeff_ptr, 0, n_coeffs * sizeof(*dqcoeff_ptr)); |
| |
| const int16x8_t zero = vdupq_n_s16(0); |
| int16x8_t v_eobmax_76543210 = vreinterpretq_s16_u16(vceqq_s16(zero, zero)); |
| |
| int16x8_t vzbins = vdupq_n_s16(zbins[1]), vround = vdupq_n_s16(round_ptr[1]); |
| int16x8_t vdequant = vdupq_n_s16(dequant_ptr[1]); |
| int16x8_t vquant = vdupq_n_s16(quant_ptr[1]); |
| int16x8_t vquant_shift = vdupq_n_s16(quant_shift_ptr[1]); |
| |
| int16x8_t v_coeff = load_tran_low_to_s16q(&coeff_ptr[0]); |
| int16x8_t v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| int16x8_t v_abs = vabsq_s16(v_coeff); |
| |
| vzbins = vsetq_lane_s16(zbins[0], vzbins, 0); |
| |
| uint16x8_t vcond = vcgeq_s16(v_abs, vzbins); |
| uint64_t nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(vcond)), 0); |
| if (nz_check) { |
| vround = vsetq_lane_s16(round_ptr[0], vround, 0); |
| vquant = vsetq_lane_s16(quant_ptr[0], vquant, 0); |
| vdequant = vsetq_lane_s16(dequant_ptr[0], vdequant, 0); |
| vquant_shift = vsetq_lane_s16(quant_shift_ptr[0], vquant_shift, 0); |
| |
| int16x8_t vtmp = vqaddq_s16(v_abs, vround); |
| int16x8_t vtmp2 = vsraq_n_s16(vtmp, vqdmulhq_s16(vtmp, vquant), 1); |
| vtmp2 = vshrq_n_s16(vqdmulhq_s16(vtmp2, vquant_shift), 1); |
| |
| int16x8_t vdest = vsubq_s16(veorq_s16(vtmp2, v_coeff_sign), v_coeff_sign); |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&qcoeff_ptr[0])); |
| store_s16q_to_tran_low(&qcoeff_ptr[0], coeff_nz_mask); |
| int16x8_t v_deq_abs = vmulq_s16(vtmp2, vdequant); |
| |
| vdest = vsubq_s16(veorq_s16(v_deq_abs, v_coeff_sign), v_coeff_sign); |
| coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&dqcoeff_ptr[0])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[0], coeff_nz_mask); |
| |
| vround = vsetq_lane_s16(round_ptr[1], vround, 0); |
| vquant = vsetq_lane_s16(quant_ptr[1], vquant, 0); |
| vdequant = vsetq_lane_s16(dequant_ptr[1], vdequant, 0); |
| vquant_shift = vsetq_lane_s16(quant_shift_ptr[1], vquant_shift, 0); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(vtmp2, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, vcond); |
| int16x8_t v_iscan = vld1q_s16(&iscan[0]); |
| vcond = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(vcond, v_iscan, v_eobmax_76543210); |
| } |
| vzbins = vsetq_lane_s16(zbins[1], vzbins, 0); |
| |
| for (int i = 8; i < n_coeffs; i += 8) { |
| v_coeff = load_tran_low_to_s16q(&coeff_ptr[i]); |
| v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| v_abs = vabsq_s16(v_coeff); |
| vcond = vcgeq_s16(v_abs, vzbins); |
| |
| nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(vcond)), 0); |
| if (nz_check) { |
| int16x8_t vtmp = vqaddq_s16(v_abs, vround); |
| int16x8_t vtmp2 = vsraq_n_s16(vtmp, vqdmulhq_s16(vtmp, vquant), 1); |
| |
| vtmp2 = vshrq_n_s16(vqdmulhq_s16(vtmp2, vquant_shift), 1); |
| int16x8_t vdest = vsubq_s16(veorq_s16(vtmp2, v_coeff_sign), v_coeff_sign); |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&qcoeff_ptr[i])); |
| store_s16q_to_tran_low(&qcoeff_ptr[i], coeff_nz_mask); |
| int16x8_t v_deq_abs = vmulq_s16(vtmp2, vdequant); |
| vdest = vsubq_s16(veorq_s16(v_deq_abs, v_coeff_sign), v_coeff_sign); |
| coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&dqcoeff_ptr[i])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[i], coeff_nz_mask); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(vtmp2, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, vcond); |
| int16x8_t v_iscan = vld1q_s16(&iscan[i]); |
| vcond = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(vcond, v_iscan, v_eobmax_76543210); |
| } |
| } |
| |
| #ifdef __aarch64__ |
| *eob_ptr = vmaxvq_s16(v_eobmax_76543210) + 1; |
| #else |
| { |
| const int16x4_t v_eobmax_3210 = vmax_s16(vget_low_s16(v_eobmax_76543210), |
| vget_high_s16(v_eobmax_76543210)); |
| const int64x1_t v_eobmax_xx32 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_3210), 32); |
| const int16x4_t v_eobmax_tmp = |
| vmax_s16(v_eobmax_3210, vreinterpret_s16_s64(v_eobmax_xx32)); |
| const int64x1_t v_eobmax_xxx3 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_tmp), 16); |
| const int16x4_t v_eobmax_final = |
| vmax_s16(v_eobmax_tmp, vreinterpret_s16_s64(v_eobmax_xxx3)); |
| |
| *eob_ptr = (uint16_t)vget_lane_s16(v_eobmax_final, 0) + 1; |
| } |
| #endif // __aarch64__ |
| } |
| |
| #define QM_MULL_SHIFT(x0, x1) \ |
| vreinterpretq_s16_u16(vorrq_u16( \ |
| vreinterpretq_u16_s16(vshlq_n_s16( \ |
| vqdmulhq_s16(x0, vreinterpretq_s16_u16(x1)), 15 - AOM_QM_BITS)), \ |
| vshrq_n_u16(vmulq_u16(vreinterpretq_u16_s16(x0), x1), AOM_QM_BITS))) |
| |
| static void aom_quantize_b_helper_16x16_neon( |
| const tran_low_t *coeff_ptr, intptr_t n_coeffs, const int16_t *zbin_ptr, |
| const int16_t *round_ptr, const int16_t *quant_ptr, |
| const int16_t *quant_shift_ptr, tran_low_t *qcoeff_ptr, |
| tran_low_t *dqcoeff_ptr, const int16_t *dequant_ptr, uint16_t *eob_ptr, |
| const int16_t *scan, const int16_t *iscan, const qm_val_t *qm_ptr, |
| const qm_val_t *iqm_ptr) { |
| (void)scan; |
| |
| uint16x8_t vwt, viwt; |
| const int zbins[2] = { zbin_ptr[0], zbin_ptr[1] }; |
| |
| memset(qcoeff_ptr, 0, n_coeffs * sizeof(*qcoeff_ptr)); |
| memset(dqcoeff_ptr, 0, n_coeffs * sizeof(*dqcoeff_ptr)); |
| |
| const int16x8_t zero = vdupq_n_s16(0); |
| int16x8_t v_eobmax_76543210 = vreinterpretq_s16_u16(vceqq_s16(zero, zero)); |
| |
| int16x8_t vzbins = vdupq_n_s16(zbins[1]), vround = vdupq_n_s16(round_ptr[1]); |
| int16x8_t vdequant = vdupq_n_s16(dequant_ptr[1]); |
| int16x8_t vquant = vdupq_n_s16(quant_ptr[1]); |
| int16x8_t vquant_shift = vdupq_n_s16(quant_shift_ptr[1]); |
| |
| int16x8_t v_coeff = load_tran_low_to_s16q(&coeff_ptr[0]); |
| int16x8_t v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| int16x8_t v_abs = vabsq_s16(v_coeff); |
| vzbins = vsetq_lane_s16(zbins[0], vzbins, 0); |
| uint16x8_t vcond; |
| if (qm_ptr == NULL) { |
| vcond = vcgeq_s16(v_abs, vzbins); |
| } else { |
| vwt = vmovl_u8(vld1_u8(&qm_ptr[0])); |
| vcond = vcgeq_s16(QM_MULL_SHIFT(v_abs, vwt), vzbins); |
| } |
| uint64_t nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(vcond)), 0); |
| if (nz_check) { |
| vround = vsetq_lane_s16(round_ptr[0], vround, 0); |
| vquant = vsetq_lane_s16(quant_ptr[0], vquant, 0); |
| vdequant = vsetq_lane_s16(dequant_ptr[0], vdequant, 0); |
| vquant_shift = vsetq_lane_s16(quant_shift_ptr[0], vquant_shift, 0); |
| |
| int16x8_t vtmp = vqaddq_s16(v_abs, vround); |
| |
| int16x8_t vtmp2; |
| if (qm_ptr == NULL) { |
| vtmp2 = vsraq_n_s16(vtmp, vqdmulhq_s16(vtmp, vquant), 1); |
| } else { |
| vtmp2 = QM_MULL_SHIFT(vtmp, vwt); |
| vtmp2 = vaddq_s16(vtmp2, vtmp); |
| } |
| |
| vtmp2 = vshrq_n_s16(vqdmulhq_s16(vtmp2, vquant_shift), 1); |
| int16x8_t vdest = vsubq_s16(veorq_s16(vtmp2, v_coeff_sign), v_coeff_sign); |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&qcoeff_ptr[0])); |
| store_s16q_to_tran_low(&qcoeff_ptr[0], coeff_nz_mask); |
| |
| if (iqm_ptr != NULL) { |
| viwt = vmovl_u8(vld1_u8(&iqm_ptr[0])); |
| vdequant = QM_MULL_SHIFT(vdequant, viwt); |
| } |
| int16x8_t v_deq_abs = vmulq_s16(vtmp2, vdequant); |
| vdest = vsubq_s16(veorq_s16(v_deq_abs, v_coeff_sign), v_coeff_sign); |
| coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&dqcoeff_ptr[0])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[0], coeff_nz_mask); |
| |
| vround = vsetq_lane_s16(round_ptr[1], vround, 0); |
| vquant = vsetq_lane_s16(quant_ptr[1], vquant, 0); |
| vdequant = vsetq_lane_s16(dequant_ptr[1], vdequant, 0); |
| vquant_shift = vsetq_lane_s16(quant_shift_ptr[1], vquant_shift, 0); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(vtmp2, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, vcond); |
| int16x8_t v_iscan = vld1q_s16(&iscan[0]); |
| vcond = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(vcond, v_iscan, v_eobmax_76543210); |
| } |
| vzbins = vsetq_lane_s16(zbins[1], vzbins, 0); |
| |
| for (int i = 8; i < n_coeffs; i += 8) { |
| v_coeff = load_tran_low_to_s16q(&coeff_ptr[i]); |
| v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| v_abs = vabsq_s16(v_coeff); |
| |
| if (qm_ptr == NULL) { |
| vcond = vcgeq_s16(v_abs, vzbins); |
| } else { |
| vwt = vmovl_u8(vld1_u8(&qm_ptr[i])); |
| vcond = vcgeq_s16(QM_MULL_SHIFT(v_abs, vwt), vzbins); |
| } |
| nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(vcond)), 0); |
| if (nz_check) { |
| int16x8_t vtmp = vqaddq_s16(v_abs, vround); |
| |
| int16x8_t vtmp2; |
| if (qm_ptr == NULL) { |
| vtmp2 = vsraq_n_s16(vtmp, vqdmulhq_s16(vtmp, vquant), 1); |
| } else { |
| vtmp2 = QM_MULL_SHIFT(vtmp, vwt); |
| vtmp2 = vaddq_s16(vtmp2, vtmp); |
| } |
| |
| vtmp2 = vshrq_n_s16(vqdmulhq_s16(vtmp2, vquant_shift), 1); |
| int16x8_t vdest = vsubq_s16(veorq_s16(vtmp2, v_coeff_sign), v_coeff_sign); |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&qcoeff_ptr[i])); |
| store_s16q_to_tran_low(&qcoeff_ptr[i], coeff_nz_mask); |
| |
| if (iqm_ptr != NULL) { |
| viwt = vmovl_u8(vld1_u8(&iqm_ptr[i])); |
| vdequant = QM_MULL_SHIFT(vdequant, viwt); |
| } |
| int16x8_t v_deq_abs = vmulq_s16(vtmp2, vdequant); |
| vdest = vsubq_s16(veorq_s16(v_deq_abs, v_coeff_sign), v_coeff_sign); |
| coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&dqcoeff_ptr[i])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[i], coeff_nz_mask); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(vtmp2, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, vcond); |
| int16x8_t v_iscan = vld1q_s16(&iscan[i]); |
| vcond = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(vcond, v_iscan, v_eobmax_76543210); |
| } |
| } |
| |
| #ifdef __aarch64__ |
| *eob_ptr = vmaxvq_s16(v_eobmax_76543210) + 1; |
| #else |
| { |
| const int16x4_t v_eobmax_3210 = vmax_s16(vget_low_s16(v_eobmax_76543210), |
| vget_high_s16(v_eobmax_76543210)); |
| const int64x1_t v_eobmax_xx32 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_3210), 32); |
| const int16x4_t v_eobmax_tmp = |
| vmax_s16(v_eobmax_3210, vreinterpret_s16_s64(v_eobmax_xx32)); |
| const int64x1_t v_eobmax_xxx3 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_tmp), 16); |
| const int16x4_t v_eobmax_final = |
| vmax_s16(v_eobmax_tmp, vreinterpret_s16_s64(v_eobmax_xxx3)); |
| |
| *eob_ptr = (uint16_t)vget_lane_s16(v_eobmax_final, 0) + 1; |
| } |
| #endif // __aarch64__ |
| } |
| |
| static void aom_quantize_b_helper_32x32_neon( |
| const tran_low_t *coeff_ptr, intptr_t n_coeffs, const int16_t *zbin_ptr, |
| const int16_t *round_ptr, const int16_t *quant_ptr, |
| const int16_t *quant_shift_ptr, tran_low_t *qcoeff_ptr, |
| tran_low_t *dqcoeff_ptr, const int16_t *dequant_ptr, uint16_t *eob_ptr, |
| const int16_t *scan, const int16_t *iscan, const qm_val_t *qm_ptr, |
| const qm_val_t *iqm_ptr) { |
| (void)scan; |
| |
| uint16x8_t vwt, viwt; |
| const int log_scale = 1; |
| const int zbins[2] = { ROUND_POWER_OF_TWO(zbin_ptr[0], log_scale), |
| ROUND_POWER_OF_TWO(zbin_ptr[1], log_scale) }; |
| |
| memset(qcoeff_ptr, 0, n_coeffs * sizeof(*qcoeff_ptr)); |
| memset(dqcoeff_ptr, 0, n_coeffs * sizeof(*dqcoeff_ptr)); |
| |
| const int16x8_t zero = vdupq_n_s16(0); |
| int16x8_t v_eobmax_76543210 = vreinterpretq_s16_u16(vceqq_s16(zero, zero)); |
| const int16x8_t v_log_scale = v_eobmax_76543210; |
| |
| int16x8_t vzbins = vdupq_n_s16(zbins[1]), |
| vround = vdupq_n_s16(ROUND_POWER_OF_TWO(round_ptr[1], log_scale)); |
| int16x8_t vdequant = vdupq_n_s16(dequant_ptr[1]); |
| int16x8_t vquant = vdupq_n_s16(quant_ptr[1]); |
| int16x8_t vquant_shift = vdupq_n_s16(quant_shift_ptr[1]); |
| |
| int16x8_t v_coeff = load_tran_low_to_s16q(&coeff_ptr[0]); |
| int16x8_t v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| int16x8_t v_abs = vabsq_s16(v_coeff); |
| vzbins = vsetq_lane_s16(zbins[0], vzbins, 0); |
| uint16x8_t vcond; |
| if (qm_ptr == NULL) { |
| vcond = vcgeq_s16(v_abs, vzbins); |
| } else { |
| vwt = vmovl_u8(vld1_u8(&qm_ptr[0])); |
| vcond = vcgeq_s16(QM_MULL_SHIFT(v_abs, vwt), vzbins); |
| } |
| uint64_t nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(vcond)), 0); |
| if (nz_check) { |
| vround = |
| vsetq_lane_s16(ROUND_POWER_OF_TWO(round_ptr[0], log_scale), vround, 0); |
| vquant = vsetq_lane_s16(quant_ptr[0], vquant, 0); |
| vdequant = vsetq_lane_s16(dequant_ptr[0], vdequant, 0); |
| vquant_shift = vsetq_lane_s16(quant_shift_ptr[0], vquant_shift, 0); |
| |
| int16x8_t vtmp = vqaddq_s16(v_abs, vround); |
| |
| int16x8_t vtmp2; |
| if (qm_ptr == NULL) { |
| vtmp2 = vsraq_n_s16(vtmp, vqdmulhq_s16(vtmp, vquant), 1); |
| } else { |
| vtmp2 = QM_MULL_SHIFT(vtmp, vwt); |
| vtmp2 = vaddq_s16(vtmp2, vtmp); |
| } |
| |
| vtmp2 = vqdmulhq_s16(vtmp2, vquant_shift); |
| int16x8_t vdest = vsubq_s16(veorq_s16(vtmp2, v_coeff_sign), v_coeff_sign); |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&qcoeff_ptr[0])); |
| store_s16q_to_tran_low(&qcoeff_ptr[0], coeff_nz_mask); |
| |
| if (iqm_ptr != NULL) { |
| viwt = vmovl_u8(vld1_u8(&iqm_ptr[0])); |
| vdequant = QM_MULL_SHIFT(vdequant, viwt); |
| } |
| int16x8_t v_deq_abs = vreinterpretq_s16_u16(vshlq_u16( |
| vreinterpretq_u16_s16(vmulq_s16(vtmp2, vdequant)), v_log_scale)); |
| vdest = vsubq_s16(veorq_s16(v_deq_abs, v_coeff_sign), v_coeff_sign); |
| coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&dqcoeff_ptr[0])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[0], coeff_nz_mask); |
| |
| vzbins = vsetq_lane_s16(zbins[1], vzbins, 0); |
| vround = |
| vsetq_lane_s16(ROUND_POWER_OF_TWO(round_ptr[1], log_scale), vround, 0); |
| vquant = vsetq_lane_s16(quant_ptr[1], vquant, 0); |
| vdequant = vsetq_lane_s16(dequant_ptr[1], vdequant, 0); |
| vquant_shift = vsetq_lane_s16(quant_shift_ptr[1], vquant_shift, 0); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(vtmp2, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, vcond); |
| int16x8_t v_iscan = vld1q_s16(&iscan[0]); |
| vcond = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(vcond, v_iscan, v_eobmax_76543210); |
| } |
| vzbins = vsetq_lane_s16(zbins[1], vzbins, 0); |
| |
| for (int i = 8; i < n_coeffs; i += 8) { |
| v_coeff = load_tran_low_to_s16q(&coeff_ptr[i]); |
| v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| v_abs = vabsq_s16(v_coeff); |
| |
| if (qm_ptr == NULL) { |
| vcond = vcgeq_s16(v_abs, vzbins); |
| } else { |
| vwt = vmovl_u8(vld1_u8(&qm_ptr[i])); |
| vcond = vcgeq_s16(QM_MULL_SHIFT(v_abs, vwt), vzbins); |
| } |
| nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(vcond)), 0); |
| if (nz_check) { |
| int16x8_t vtmp = vqaddq_s16(v_abs, vround); |
| |
| int16x8_t vtmp2; |
| if (qm_ptr == NULL) { |
| vtmp2 = vsraq_n_s16(vtmp, vqdmulhq_s16(vtmp, vquant), 1); |
| } else { |
| vtmp2 = QM_MULL_SHIFT(vtmp, vwt); |
| vtmp2 = vaddq_s16(vtmp2, vtmp); |
| } |
| vtmp2 = vqdmulhq_s16(vtmp2, vquant_shift); |
| |
| int16x8_t vdest = vsubq_s16(veorq_s16(vtmp2, v_coeff_sign), v_coeff_sign); |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&qcoeff_ptr[i])); |
| store_s16q_to_tran_low(&qcoeff_ptr[i], coeff_nz_mask); |
| |
| if (iqm_ptr != NULL) { |
| viwt = vmovl_u8(vld1_u8(&iqm_ptr[i])); |
| vdequant = QM_MULL_SHIFT(vdequant, viwt); |
| } |
| int16x8_t v_deq_abs = vreinterpretq_s16_u16(vshlq_u16( |
| vreinterpretq_u16_s16(vmulq_s16(vtmp2, vdequant)), v_log_scale)); |
| vdest = vsubq_s16(veorq_s16(v_deq_abs, v_coeff_sign), v_coeff_sign); |
| coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&dqcoeff_ptr[i])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[i], coeff_nz_mask); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(vtmp2, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, vcond); |
| int16x8_t v_iscan = vld1q_s16(&iscan[i]); |
| vcond = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(vcond, v_iscan, v_eobmax_76543210); |
| } |
| } |
| |
| #ifdef __aarch64__ |
| *eob_ptr = vmaxvq_s16(v_eobmax_76543210) + 1; |
| #else |
| { |
| const int16x4_t v_eobmax_3210 = vmax_s16(vget_low_s16(v_eobmax_76543210), |
| vget_high_s16(v_eobmax_76543210)); |
| const int64x1_t v_eobmax_xx32 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_3210), 32); |
| const int16x4_t v_eobmax_tmp = |
| vmax_s16(v_eobmax_3210, vreinterpret_s16_s64(v_eobmax_xx32)); |
| const int64x1_t v_eobmax_xxx3 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_tmp), 16); |
| const int16x4_t v_eobmax_final = |
| vmax_s16(v_eobmax_tmp, vreinterpret_s16_s64(v_eobmax_xxx3)); |
| |
| *eob_ptr = (uint16_t)vget_lane_s16(v_eobmax_final, 0) + 1; |
| } |
| #endif // __aarch64__ |
| } |
| |
| static void aom_quantize_b_helper_64x64_neon( |
| const tran_low_t *coeff_ptr, intptr_t n_coeffs, const int16_t *zbin_ptr, |
| const int16_t *round_ptr, const int16_t *quant_ptr, |
| const int16_t *quant_shift_ptr, tran_low_t *qcoeff_ptr, |
| tran_low_t *dqcoeff_ptr, const int16_t *dequant_ptr, uint16_t *eob_ptr, |
| const int16_t *scan, const int16_t *iscan, const qm_val_t *qm_ptr, |
| const qm_val_t *iqm_ptr) { |
| (void)scan; |
| |
| uint16x8_t vwt, viwt; |
| const int log_scale = 2; |
| const int16x8_t v_log_scale = |
| vreinterpretq_s16_s64(vdupq_n_s64(0xFFFEFFFEFFFEFFFE)); |
| |
| const int zbins[2] = { ROUND_POWER_OF_TWO(zbin_ptr[0], log_scale), |
| ROUND_POWER_OF_TWO(zbin_ptr[1], log_scale) }; |
| |
| memset(qcoeff_ptr, 0, n_coeffs * sizeof(*qcoeff_ptr)); |
| memset(dqcoeff_ptr, 0, n_coeffs * sizeof(*dqcoeff_ptr)); |
| |
| const int16x8_t zero = vdupq_n_s16(0); |
| int16x8_t v_eobmax_76543210 = vreinterpretq_s16_u16(vceqq_s16(zero, zero)); |
| int16x8_t v_ones = vnegq_s16(v_eobmax_76543210); |
| |
| int16x8_t vzbins = vdupq_n_s16(zbins[1]), |
| vround = vdupq_n_s16(ROUND_POWER_OF_TWO(round_ptr[1], log_scale)); |
| int16x8_t vdequant = vdupq_n_s16(dequant_ptr[1]); |
| int16x8_t vquant = vdupq_n_s16(quant_ptr[1]); |
| int16x8_t vquant_shift = vdupq_n_s16(quant_shift_ptr[1]); |
| |
| int16x8_t v_coeff = load_tran_low_to_s16q(&coeff_ptr[0]); |
| int16x8_t v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| int16x8_t v_abs = vabsq_s16(v_coeff); |
| vzbins = vsetq_lane_s16(zbins[0], vzbins, 0); |
| uint16x8_t vcond; |
| if (qm_ptr == NULL) { |
| vcond = vcgeq_s16(v_abs, vzbins); |
| } else { |
| vwt = vmovl_u8(vld1_u8(&qm_ptr[0])); |
| vcond = vcgeq_s16(QM_MULL_SHIFT(v_abs, vwt), vzbins); |
| } |
| uint64_t nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(vcond)), 0); |
| if (nz_check) { |
| vround = |
| vsetq_lane_s16(ROUND_POWER_OF_TWO(round_ptr[0], log_scale), vround, 0); |
| vquant = vsetq_lane_s16(quant_ptr[0], vquant, 0); |
| vdequant = vsetq_lane_s16(dequant_ptr[0], vdequant, 0); |
| vquant_shift = vsetq_lane_s16(quant_shift_ptr[0], vquant_shift, 0); |
| int16x8_t vtmp = vqaddq_s16(v_abs, vround); |
| |
| int16x8_t vtmp2; |
| if (qm_ptr == NULL) { |
| vtmp2 = vsraq_n_s16(vtmp, vqdmulhq_s16(vtmp, vquant), 1); |
| } else { |
| vtmp2 = QM_MULL_SHIFT(vtmp, vwt); |
| vtmp2 = vaddq_s16(vtmp2, vtmp); |
| } |
| |
| int16x8_t ones = |
| vandq_s16(vshrq_n_s16(vmulq_s16(vtmp2, vquant_shift), 14), v_ones); |
| vtmp2 = |
| vaddq_s16(vshlq_s16(vqdmulhq_s16(vtmp2, vquant_shift), v_ones), ones); |
| int16x8_t vdest = vsubq_s16(veorq_s16(vtmp2, v_coeff_sign), v_coeff_sign); |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&qcoeff_ptr[0])); |
| store_s16q_to_tran_low(&qcoeff_ptr[0], coeff_nz_mask); |
| |
| if (iqm_ptr != NULL) { |
| viwt = vmovl_u8(vld1_u8(&iqm_ptr[0])); |
| vdequant = QM_MULL_SHIFT(vdequant, viwt); |
| } |
| int16x8_t v_deq_abs = vreinterpretq_s16_u16(vshlq_u16( |
| vreinterpretq_u16_s16(vmulq_s16(vtmp2, vdequant)), v_log_scale)); |
| v_deq_abs = |
| vorrq_s16(vshlq_n_s16(vqdmulhq_s16(vtmp2, vdequant), 13), v_deq_abs); |
| vdest = vsubq_s16(veorq_s16(v_deq_abs, v_coeff_sign), v_coeff_sign); |
| coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&dqcoeff_ptr[0])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[0], coeff_nz_mask); |
| |
| vround = |
| vsetq_lane_s16(ROUND_POWER_OF_TWO(round_ptr[1], log_scale), vround, 0); |
| vquant = vsetq_lane_s16(quant_ptr[1], vquant, 0); |
| vdequant = vsetq_lane_s16(dequant_ptr[1], vdequant, 0); |
| vquant_shift = vsetq_lane_s16(quant_shift_ptr[1], vquant_shift, 0); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(vtmp2, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, vcond); |
| int16x8_t v_iscan = vld1q_s16(&iscan[0]); |
| vcond = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(vcond, v_iscan, v_eobmax_76543210); |
| } |
| vzbins = vsetq_lane_s16(zbins[1], vzbins, 0); |
| |
| for (int i = 8; i < n_coeffs; i += 8) { |
| v_coeff = load_tran_low_to_s16q(&coeff_ptr[i]); |
| v_coeff_sign = vshrq_n_s16(v_coeff, 15); |
| v_abs = vabsq_s16(v_coeff); |
| |
| if (qm_ptr == NULL) { |
| vcond = vcgeq_s16(v_abs, vzbins); |
| } else { |
| vwt = vmovl_u8(vld1_u8(&qm_ptr[i])); |
| vcond = vcgeq_s16(QM_MULL_SHIFT(v_abs, vwt), vzbins); |
| } |
| nz_check = vget_lane_u64(vreinterpret_u64_u8(vmovn_u16(vcond)), 0); |
| if (nz_check) { |
| int16x8_t vtmp = vqaddq_s16(v_abs, vround); |
| |
| int16x8_t vtmp2; |
| if (qm_ptr == NULL) { |
| vtmp2 = vsraq_n_s16(vtmp, vqdmulhq_s16(vtmp, vquant), 1); |
| } else { |
| vtmp2 = QM_MULL_SHIFT(vtmp, vwt); |
| vtmp2 = vaddq_s16(vtmp2, vtmp); |
| } |
| |
| int16x8_t ones = |
| vandq_s16(vshrq_n_s16(vmulq_s16(vtmp2, vquant_shift), 14), v_ones); |
| vtmp2 = |
| vaddq_s16(vshlq_s16(vqdmulhq_s16(vtmp2, vquant_shift), v_ones), ones); |
| int16x8_t vdest = vsubq_s16(veorq_s16(vtmp2, v_coeff_sign), v_coeff_sign); |
| int16x8_t coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&qcoeff_ptr[i])); |
| store_s16q_to_tran_low(&qcoeff_ptr[i], coeff_nz_mask); |
| |
| if (iqm_ptr != NULL) { |
| viwt = vmovl_u8(vld1_u8(&iqm_ptr[i])); |
| vdequant = QM_MULL_SHIFT(vdequant, viwt); |
| } |
| int16x8_t v_deq_abs = vreinterpretq_s16_u16(vshlq_u16( |
| vreinterpretq_u16_s16(vmulq_s16(vtmp2, vdequant)), v_log_scale)); |
| v_deq_abs = |
| vorrq_s16(vshlq_n_s16(vqdmulhq_s16(vtmp2, vdequant), 13), v_deq_abs); |
| vdest = vsubq_s16(veorq_s16(v_deq_abs, v_coeff_sign), v_coeff_sign); |
| coeff_nz_mask = |
| vbslq_s16(vcond, vdest, load_tran_low_to_s16q(&dqcoeff_ptr[i])); |
| store_s16q_to_tran_low(&dqcoeff_ptr[i], coeff_nz_mask); |
| |
| uint16x8_t vtmp_mask = vcgtq_s16(vtmp2, zero); |
| const uint16x8_t v_nz_mask = vandq_u16(vtmp_mask, vcond); |
| int16x8_t v_iscan = vld1q_s16(&iscan[i]); |
| vcond = vandq_u16(v_nz_mask, vcgtq_s16(v_iscan, v_eobmax_76543210)); |
| v_eobmax_76543210 = vbslq_s16(vcond, v_iscan, v_eobmax_76543210); |
| } |
| } |
| |
| #ifdef __aarch64__ |
| *eob_ptr = vmaxvq_s16(v_eobmax_76543210) + 1; |
| #else |
| { |
| const int16x4_t v_eobmax_3210 = vmax_s16(vget_low_s16(v_eobmax_76543210), |
| vget_high_s16(v_eobmax_76543210)); |
| const int64x1_t v_eobmax_xx32 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_3210), 32); |
| const int16x4_t v_eobmax_tmp = |
| vmax_s16(v_eobmax_3210, vreinterpret_s16_s64(v_eobmax_xx32)); |
| const int64x1_t v_eobmax_xxx3 = |
| vshr_n_s64(vreinterpret_s64_s16(v_eobmax_tmp), 16); |
| const int16x4_t v_eobmax_final = |
| vmax_s16(v_eobmax_tmp, vreinterpret_s16_s64(v_eobmax_xxx3)); |
| |
| *eob_ptr = (uint16_t)vget_lane_s16(v_eobmax_final, 0) + 1; |
| } |
| #endif // __aarch64__ |
| } |
| |
| void aom_quantize_b_helper_neon( |
| const tran_low_t *coeff_ptr, intptr_t n_coeffs, const int16_t *zbin_ptr, |
| const int16_t *round_ptr, const int16_t *quant_ptr, |
| const int16_t *quant_shift_ptr, tran_low_t *qcoeff_ptr, |
| tran_low_t *dqcoeff_ptr, const int16_t *dequant_ptr, uint16_t *eob_ptr, |
| const int16_t *scan, const int16_t *iscan, const qm_val_t *qm_ptr, |
| const qm_val_t *iqm_ptr, const int log_scale) { |
| switch (log_scale) { // log_scale for AV1 encoder can be only 0, 1, 2 |
| case 0: |
| aom_quantize_b_helper_16x16_neon(coeff_ptr, n_coeffs, zbin_ptr, round_ptr, |
| quant_ptr, quant_shift_ptr, qcoeff_ptr, |
| dqcoeff_ptr, dequant_ptr, eob_ptr, scan, |
| iscan, qm_ptr, iqm_ptr); |
| break; |
| case 1: |
| aom_quantize_b_helper_32x32_neon(coeff_ptr, n_coeffs, zbin_ptr, round_ptr, |
| quant_ptr, quant_shift_ptr, qcoeff_ptr, |
| dqcoeff_ptr, dequant_ptr, eob_ptr, scan, |
| iscan, qm_ptr, iqm_ptr); |
| break; |
| case 2: |
| aom_quantize_b_helper_64x64_neon(coeff_ptr, n_coeffs, zbin_ptr, round_ptr, |
| quant_ptr, quant_shift_ptr, qcoeff_ptr, |
| dqcoeff_ptr, dequant_ptr, eob_ptr, scan, |
| iscan, qm_ptr, iqm_ptr); |
| break; |
| } |
| } |
| |
| void aom_quantize_b_32x32_neon(const tran_low_t *coeff_ptr, intptr_t n_coeffs, |
| const int16_t *zbin_ptr, |
| const int16_t *round_ptr, |
| const int16_t *quant_ptr, |
| const int16_t *quant_shift_ptr, |
| tran_low_t *qcoeff_ptr, tran_low_t *dqcoeff_ptr, |
| const int16_t *dequant_ptr, uint16_t *eob_ptr, |
| const int16_t *scan, const int16_t *iscan) { |
| aom_quantize_b_helper_neon(coeff_ptr, n_coeffs, zbin_ptr, round_ptr, |
| quant_ptr, quant_shift_ptr, qcoeff_ptr, |
| dqcoeff_ptr, dequant_ptr, eob_ptr, scan, iscan, |
| NULL, NULL, 1); |
| } |
| |
| void aom_quantize_b_64x64_neon(const tran_low_t *coeff_ptr, intptr_t n_coeffs, |
| const int16_t *zbin_ptr, |
| const int16_t *round_ptr, |
| const int16_t *quant_ptr, |
| const int16_t *quant_shift_ptr, |
| tran_low_t *qcoeff_ptr, tran_low_t *dqcoeff_ptr, |
| const int16_t *dequant_ptr, uint16_t *eob_ptr, |
| const int16_t *scan, const int16_t *iscan) { |
| aom_quantize_b_helper_neon(coeff_ptr, n_coeffs, zbin_ptr, round_ptr, |
| quant_ptr, quant_shift_ptr, qcoeff_ptr, |
| dqcoeff_ptr, dequant_ptr, eob_ptr, scan, iscan, |
| NULL, NULL, 2); |
| } |
