/*
* Copyright (c) 2021 Loongson Technology Corporation Limited
* Contributed by Xiwei Gu <guxiwei-hf@loongson.cn>
*
* This file is part of FFmpeg.
*
* FFmpeg is free software; you can redistribute it and/or
* modify it under the terms of the GNU Lesser General Public
* License as published by the Free Software Foundation; either
* version 2.1 of the License, or (at your option) any later version.
*
* FFmpeg is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public
* License along with FFmpeg; if not, write to the Free Software
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
*/
#include "libavcodec/bit_depth_template.c"
#include "h264dsp_loongarch.h"
#include "libavutil/loongarch/loongson_intrinsics.h"
#define H264_LOOP_FILTER_STRENGTH_ITERATION_LASX(edges, step, mask_mv, dir, \
d_idx, mask_dir) \
do { \
int b_idx = 0; \
int step_x4 = step << 2; \
int d_idx_12 = d_idx + 12; \
int d_idx_52 = d_idx + 52; \
int d_idx_x4 = d_idx << 2; \
int d_idx_x4_48 = d_idx_x4 + 48; \
int dir_x32 = dir * 32; \
uint8_t *ref_t = (uint8_t*)ref; \
uint8_t *mv_t = (uint8_t*)mv; \
uint8_t *nnz_t = (uint8_t*)nnz; \
uint8_t *bS_t = (uint8_t*)bS; \
mask_mv <<= 3; \
for (; b_idx < edges; b_idx += step) { \
out &= mask_dir; \
if (!(mask_mv & b_idx)) { \
if (bidir) { \
ref2 = __lasx_xvldx(ref_t, d_idx_12); \
ref3 = __lasx_xvldx(ref_t, d_idx_52); \
ref0 = __lasx_xvld(ref_t, 12); \
ref1 = __lasx_xvld(ref_t, 52); \
ref2 = __lasx_xvilvl_w(ref3, ref2); \
ref0 = __lasx_xvilvl_w(ref0, ref0); \
ref1 = __lasx_xvilvl_w(ref1, ref1); \
ref3 = __lasx_xvshuf4i_w(ref2, 0xB1); \
ref0 = __lasx_xvsub_b(ref0, ref2); \
ref1 = __lasx_xvsub_b(ref1, ref3); \
ref0 = __lasx_xvor_v(ref0, ref1); \
\
tmp2 = __lasx_xvldx(mv_t, d_idx_x4_48); \
tmp3 = __lasx_xvld(mv_t, 48); \
tmp4 = __lasx_xvld(mv_t, 208); \
tmp5 = __lasx_xvld(mv_t + d_idx_x4, 208); \
DUP2_ARG3(__lasx_xvpermi_q, tmp2, tmp2, 0x20, tmp5, tmp5, \
0x20, tmp2, tmp5); \
tmp3 = __lasx_xvpermi_q(tmp4, tmp3, 0x20); \
tmp2 = __lasx_xvsub_h(tmp2, tmp3); \
tmp5 = __lasx_xvsub_h(tmp5, tmp3); \
DUP2_ARG2(__lasx_xvsat_h, tmp2, 7, tmp5, 7, tmp2, tmp5); \
tmp0 = __lasx_xvpickev_b(tmp5, tmp2); \
tmp0 = __lasx_xvpermi_d(tmp0, 0xd8); \
tmp0 = __lasx_xvadd_b(tmp0, cnst_1); \
tmp0 = __lasx_xvssub_bu(tmp0, cnst_0); \
tmp0 = __lasx_xvsat_h(tmp0, 7); \
tmp0 = __lasx_xvpickev_b(tmp0, tmp0); \
tmp0 = __lasx_xvpermi_d(tmp0, 0xd8); \
tmp1 = __lasx_xvpickod_d(tmp0, tmp0); \
out = __lasx_xvor_v(ref0, tmp0); \
tmp1 = __lasx_xvshuf4i_w(tmp1, 0xB1); \
out = __lasx_xvor_v(out, tmp1); \
tmp0 = __lasx_xvshuf4i_w(out, 0xB1); \
out = __lasx_xvmin_bu(out, tmp0); \
} else { \
ref0 = __lasx_xvldx(ref_t, d_idx_12); \
ref3 = __lasx_xvld(ref_t, 12); \
tmp2 = __lasx_xvldx(mv_t, d_idx_x4_48); \
tmp3 = __lasx_xvld(mv_t, 48); \
tmp4 = __lasx_xvsub_h(tmp3, tmp2); \
tmp1 = __lasx_xvsat_h(tmp4, 7); \
tmp1 = __lasx_xvpickev_b(tmp1, tmp1); \
tmp1 = __lasx_xvadd_b(tmp1, cnst_1); \
out = __lasx_xvssub_bu(tmp1, cnst_0); \
out = __lasx_xvsat_h(out, 7); \
out = __lasx_xvpickev_b(out, out); \
ref0 = __lasx_xvsub_b(ref3, ref0); \
out = __lasx_xvor_v(out, ref0); \
} \
} \
tmp0 = __lasx_xvld(nnz_t, 12); \
tmp1 = __lasx_xvldx(nnz_t, d_idx_12); \
tmp0 = __lasx_xvor_v(tmp0, tmp1); \
tmp0 = __lasx_xvmin_bu(tmp0, cnst_2); \
out = __lasx_xvmin_bu(out, cnst_2); \
tmp0 = __lasx_xvslli_h(tmp0, 1); \
tmp0 = __lasx_xvmax_bu(out, tmp0); \
tmp0 = __lasx_vext2xv_hu_bu(tmp0); \
__lasx_xvstelm_d(tmp0, bS_t + dir_x32, 0, 0); \
ref_t += step; \
mv_t += step_x4; \
nnz_t += step; \
bS_t += step; \
} \
} while(0)
void ff_h264_loop_filter_strength_lasx(int16_t bS[2][4][4], uint8_t nnz[40],
int8_t ref[2][40], int16_t mv[2][40][2],
int bidir, int edges, int step,
int mask_mv0, int mask_mv1, int field)
{
__m256i out;
__m256i ref0, ref1, ref2, ref3;
__m256i tmp0, tmp1;
__m256i tmp2, tmp3, tmp4, tmp5;
__m256i cnst_0, cnst_1, cnst_2;
__m256i zero = __lasx_xvldi(0);
__m256i one = __lasx_xvnor_v(zero, zero);
int64_t cnst3 = 0x0206020602060206, cnst4 = 0x0103010301030103;
if (field) {
cnst_0 = __lasx_xvreplgr2vr_d(cnst3);
cnst_1 = __lasx_xvreplgr2vr_d(cnst4);
cnst_2 = __lasx_xvldi(0x01);
} else {
DUP2_ARG1(__lasx_xvldi, 0x06, 0x03, cnst_0, cnst_1);
cnst_2 = __lasx_xvldi(0x01);
}
step <<= 3;
edges <<= 3;
H264_LOOP_FILTER_STRENGTH_ITERATION_LASX(edges, step, mask_mv1,
1, -8, zero);
H264_LOOP_FILTER_STRENGTH_ITERATION_LASX(32, 8, mask_mv0, 0, -1, one);
DUP2_ARG2(__lasx_xvld, (int8_t*)bS, 0, (int8_t*)bS, 16, tmp0, tmp1);
DUP2_ARG2(__lasx_xvilvh_d, tmp0, tmp0, tmp1, tmp1, tmp2, tmp3);
LASX_TRANSPOSE4x4_H(tmp0, tmp2, tmp1, tmp3, tmp2, tmp3, tmp4, tmp5);
__lasx_xvstelm_d(tmp2, (int8_t*)bS, 0, 0);
__lasx_xvstelm_d(tmp3, (int8_t*)bS + 8, 0, 0);
__lasx_xvstelm_d(tmp4, (int8_t*)bS + 16, 0, 0);
__lasx_xvstelm_d(tmp5, (int8_t*)bS + 24, 0, 0);
}