av1_highbd_quantize_neon.c (6291B)
1 /* 2 * Copyright (c) 2022, Alliance for Open Media. All rights reserved. 3 * 4 * This source code is subject to the terms of the BSD 2 Clause License and 5 * the Alliance for Open Media Patent License 1.0. If the BSD 2 Clause License 6 * was not distributed with this source code in the LICENSE file, you can 7 * obtain it at www.aomedia.org/license/software. If the Alliance for Open 8 * Media Patent License 1.0 was not distributed with this source code in the 9 * PATENTS file, you can obtain it at www.aomedia.org/license/patent. 10 */ 11 12 #include <arm_neon.h> 13 14 #include "config/aom_config.h" 15 16 #include "aom_dsp/arm/mem_neon.h" 17 18 #include "av1/common/quant_common.h" 19 #include "av1/encoder/av1_quantize.h" 20 21 static inline uint16x4_t quantize_4(const tran_low_t *coeff_ptr, 22 tran_low_t *qcoeff_ptr, 23 tran_low_t *dqcoeff_ptr, 24 int32x4_t v_quant_s32, 25 int32x4_t v_dequant_s32, 26 int32x4_t v_round_s32, int log_scale) { 27 const int32x4_t v_coeff = vld1q_s32(coeff_ptr); 28 const int32x4_t v_coeff_sign = 29 vreinterpretq_s32_u32(vcltq_s32(v_coeff, vdupq_n_s32(0))); 30 const int32x4_t v_log_scale = vdupq_n_s32(log_scale); 31 const int32x4_t v_abs_coeff = vabsq_s32(v_coeff); 32 // ((abs_coeff << (1 + log_scale)) >= dequant_ptr[rc01]) 33 const int32x4_t v_abs_coeff_scaled = 34 vshlq_s32(v_abs_coeff, vdupq_n_s32(1 + log_scale)); 35 const uint32x4_t v_mask = vcgeq_s32(v_abs_coeff_scaled, v_dequant_s32); 36 // const int64_t tmp = vmask ? (int64_t)abs_coeff + log_scaled_round : 0 37 const int32x4_t v_tmp = vandq_s32(vaddq_s32(v_abs_coeff, v_round_s32), 38 vreinterpretq_s32_u32(v_mask)); 39 // const int abs_qcoeff = (int)((tmp * quant) >> (16 - log_scale)); 40 const int32x4_t v_abs_qcoeff = 41 vqdmulhq_s32(vshlq_s32(v_tmp, v_log_scale), v_quant_s32); 42 // qcoeff_ptr[rc] = (tran_low_t)((abs_qcoeff ^ coeff_sign) - coeff_sign); 43 const int32x4_t v_qcoeff = 44 vsubq_s32(veorq_s32(v_abs_qcoeff, v_coeff_sign), v_coeff_sign); 45 // vshlq_s32 will shift right if shift value is negative. 46 const int32x4_t v_abs_dqcoeff = 47 vshlq_s32(vmulq_s32(v_abs_qcoeff, v_dequant_s32), vnegq_s32(v_log_scale)); 48 // dqcoeff_ptr[rc] = (tran_low_t)((abs_dqcoeff ^ coeff_sign) - coeff_sign); 49 const int32x4_t v_dqcoeff = 50 vsubq_s32(veorq_s32(v_abs_dqcoeff, v_coeff_sign), v_coeff_sign); 51 52 vst1q_s32(qcoeff_ptr, v_qcoeff); 53 vst1q_s32(dqcoeff_ptr, v_dqcoeff); 54 55 // Used to find eob. 56 const uint32x4_t nz_qcoeff_mask = vcgtq_s32(v_abs_qcoeff, vdupq_n_s32(0)); 57 return vmovn_u32(nz_qcoeff_mask); 58 } 59 60 static inline int16x8_t get_max_lane_eob(const int16_t *iscan, 61 int16x8_t v_eobmax, 62 uint16x8_t v_mask) { 63 const int16x8_t v_iscan = vld1q_s16(&iscan[0]); 64 const int16x8_t v_iscan_plus1 = vaddq_s16(v_iscan, vdupq_n_s16(1)); 65 const int16x8_t v_nz_iscan = vbslq_s16(v_mask, v_iscan_plus1, vdupq_n_s16(0)); 66 return vmaxq_s16(v_eobmax, v_nz_iscan); 67 } 68 69 static inline uint16_t get_max_eob(int16x8_t v_eobmax) { 70 #if AOM_ARCH_AARCH64 71 return (uint16_t)vmaxvq_s16(v_eobmax); 72 #else 73 const int16x4_t v_eobmax_3210 = 74 vmax_s16(vget_low_s16(v_eobmax), vget_high_s16(v_eobmax)); 75 const int64x1_t v_eobmax_xx32 = 76 vshr_n_s64(vreinterpret_s64_s16(v_eobmax_3210), 32); 77 const int16x4_t v_eobmax_tmp = 78 vmax_s16(v_eobmax_3210, vreinterpret_s16_s64(v_eobmax_xx32)); 79 const int64x1_t v_eobmax_xxx3 = 80 vshr_n_s64(vreinterpret_s64_s16(v_eobmax_tmp), 16); 81 const int16x4_t v_eobmax_final = 82 vmax_s16(v_eobmax_tmp, vreinterpret_s16_s64(v_eobmax_xxx3)); 83 return (uint16_t)vget_lane_s16(v_eobmax_final, 0); 84 #endif 85 } 86 87 void av1_highbd_quantize_fp_neon( 88 const tran_low_t *coeff_ptr, intptr_t count, const int16_t *zbin_ptr, 89 const int16_t *round_ptr, const int16_t *quant_ptr, 90 const int16_t *quant_shift_ptr, tran_low_t *qcoeff_ptr, 91 tran_low_t *dqcoeff_ptr, const int16_t *dequant_ptr, uint16_t *eob_ptr, 92 const int16_t *scan, const int16_t *iscan, int log_scale) { 93 (void)scan; 94 (void)zbin_ptr; 95 (void)quant_shift_ptr; 96 97 const int16x4_t v_quant = vld1_s16(quant_ptr); 98 const int16x4_t v_dequant = vld1_s16(dequant_ptr); 99 const int16x4_t v_zero = vdup_n_s16(0); 100 const uint16x4_t v_round_select = vcgt_s16(vdup_n_s16(log_scale), v_zero); 101 const int16x4_t v_round_no_scale = vld1_s16(round_ptr); 102 const int16x4_t v_round_log_scale = 103 vqrdmulh_n_s16(v_round_no_scale, (int16_t)(1 << (15 - log_scale))); 104 const int16x4_t v_round = 105 vbsl_s16(v_round_select, v_round_log_scale, v_round_no_scale); 106 int32x4_t v_round_s32 = vaddl_s16(v_round, v_zero); 107 int32x4_t v_quant_s32 = vshlq_n_s32(vaddl_s16(v_quant, v_zero), 15); 108 int32x4_t v_dequant_s32 = vaddl_s16(v_dequant, v_zero); 109 uint16x4_t v_mask_lo, v_mask_hi; 110 int16x8_t v_eobmax = vdupq_n_s16(-1); 111 112 // DC and first 3 AC 113 v_mask_lo = quantize_4(coeff_ptr, qcoeff_ptr, dqcoeff_ptr, v_quant_s32, 114 v_dequant_s32, v_round_s32, log_scale); 115 116 // overwrite the DC constants with AC constants 117 v_round_s32 = vdupq_lane_s32(vget_low_s32(v_round_s32), 1); 118 v_quant_s32 = vdupq_lane_s32(vget_low_s32(v_quant_s32), 1); 119 v_dequant_s32 = vdupq_lane_s32(vget_low_s32(v_dequant_s32), 1); 120 121 // 4 more AC 122 v_mask_hi = quantize_4(coeff_ptr + 4, qcoeff_ptr + 4, dqcoeff_ptr + 4, 123 v_quant_s32, v_dequant_s32, v_round_s32, log_scale); 124 125 // Find the max lane eob for the first 8 coeffs. 126 v_eobmax = 127 get_max_lane_eob(iscan, v_eobmax, vcombine_u16(v_mask_lo, v_mask_hi)); 128 129 count -= 8; 130 do { 131 coeff_ptr += 8; 132 qcoeff_ptr += 8; 133 dqcoeff_ptr += 8; 134 iscan += 8; 135 v_mask_lo = quantize_4(coeff_ptr, qcoeff_ptr, dqcoeff_ptr, v_quant_s32, 136 v_dequant_s32, v_round_s32, log_scale); 137 v_mask_hi = quantize_4(coeff_ptr + 4, qcoeff_ptr + 4, dqcoeff_ptr + 4, 138 v_quant_s32, v_dequant_s32, v_round_s32, log_scale); 139 // Find the max lane eob for 8 coeffs. 140 v_eobmax = 141 get_max_lane_eob(iscan, v_eobmax, vcombine_u16(v_mask_lo, v_mask_hi)); 142 count -= 8; 143 } while (count); 144 145 *eob_ptr = get_max_eob(v_eobmax); 146 }