mirror of https://git.ffmpeg.org/ffmpeg.git
313 lines
8.4 KiB
ArmAsm
313 lines
8.4 KiB
ArmAsm
/*
|
|
* Copyright © 2023 Rémi Denis-Courmont.
|
|
*
|
|
* 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 "libavutil/riscv/asm.S"
|
|
|
|
func ff_sbr_sum64x5_rvv, zve32f
|
|
li a5, 64
|
|
addi a1, a0, 64 * 4
|
|
addi a2, a0, 128 * 4
|
|
addi a3, a0, 192 * 4
|
|
addi a4, a0, 256 * 4
|
|
1:
|
|
vsetvli t0, a5, e32, m8, ta, ma
|
|
sub a5, a5, t0
|
|
vle32.v v0, (a0)
|
|
vle32.v v8, (a1)
|
|
sh2add a1, t0, a1
|
|
vle32.v v16, (a2)
|
|
vfadd.vv v0, v0, v8
|
|
sh2add a2, t0, a2
|
|
vle32.v v24, (a3)
|
|
vfadd.vv v0, v0, v16
|
|
sh2add a3, t0, a3
|
|
vle32.v v8, (a4)
|
|
vfadd.vv v0, v0, v24
|
|
sh2add a4, t0, a4
|
|
vfadd.vv v0, v0, v8
|
|
vse32.v v0, (a0)
|
|
sh2add a0, t0, a0
|
|
bnez a5, 1b
|
|
|
|
ret
|
|
endfunc
|
|
|
|
func ff_sbr_sum_square_rvv, zve32f
|
|
vsetvli t0, zero, e32, m8, ta, ma
|
|
slli a1, a1, 1
|
|
vmv.v.x v8, zero
|
|
vmv.s.x v0, zero
|
|
1:
|
|
vsetvli t0, a1, e32, m8, tu, ma
|
|
vle32.v v16, (a0)
|
|
sub a1, a1, t0
|
|
vfmacc.vv v8, v16, v16
|
|
sh2add a0, t0, a0
|
|
bnez a1, 1b
|
|
|
|
vfredusum.vs v0, v8, v0
|
|
vfmv.f.s fa0, v0
|
|
NOHWF fmv.x.w a0, fa0
|
|
ret
|
|
endfunc
|
|
|
|
#if __riscv_xlen >= 64
|
|
func ff_sbr_neg_odd_64_rvv, zve64x
|
|
li a1, 32
|
|
li t1, 1 << 63
|
|
1:
|
|
vsetvli t0, a1, e64, m8, ta, ma
|
|
vle64.v v8, (a0)
|
|
sub a1, a1, t0
|
|
vxor.vx v8, v8, t1
|
|
vse64.v v8, (a0)
|
|
sh3add a0, t0, a0
|
|
bnez t0, 1b
|
|
|
|
ret
|
|
endfunc
|
|
#endif
|
|
|
|
func ff_sbr_autocorrelate_rvv, zve32f
|
|
vsetvli t0, zero, e32, m4, ta, ma
|
|
vmv.v.x v0, zero
|
|
flw fa0, (a0)
|
|
vmv.v.x v4, zero
|
|
flw fa1, 4(a0)
|
|
vmv.v.x v8, zero
|
|
flw fa2, 8(a0)
|
|
li a2, 37
|
|
flw fa3, 12(a0)
|
|
fmul.s ft10, fa0, fa0
|
|
flw fa4, 16(a0)
|
|
fmul.s ft6, fa0, fa2
|
|
flw fa5, 20(a0)
|
|
addi a0, a0, 38 * 8
|
|
fmul.s ft7, fa0, fa3
|
|
fmul.s ft2, fa0, fa4
|
|
fmul.s ft3, fa0, fa5
|
|
flw fa0, (a0)
|
|
fmadd.s ft10, fa1, fa1, ft10
|
|
fmadd.s ft6, fa1, fa3, ft6
|
|
flw fa3, 12(a0)
|
|
fnmsub.s ft7, fa1, fa2, ft7
|
|
flw fa2, 8(a0)
|
|
fmadd.s ft2, fa1, fa5, ft2
|
|
fnmsub.s ft3, fa1, fa4, ft3
|
|
flw fa1, 4(a0)
|
|
fmul.s ft4, fa0, fa0
|
|
fmul.s ft0, fa0, fa2
|
|
fmul.s ft1, fa0, fa3
|
|
fmadd.s ft4, fa1, fa1, ft4
|
|
fmadd.s ft0, fa1, fa3, ft0
|
|
fnmsub.s ft1, fa1, fa2, ft1
|
|
1:
|
|
vsetvli t0, a2, e32, m2, tu, ma
|
|
slli t1, t0, 3
|
|
sub a0, a0, t1
|
|
vlseg2e32.v v16, (a0)
|
|
sub a2, a2, t0
|
|
vfmacc.vv v0, v16, v16
|
|
vfslide1down.vf v20, v16, fa0
|
|
vfmacc.vv v4, v16, v20
|
|
vfslide1down.vf v22, v18, fa1
|
|
vfmacc.vv v0, v18, v18
|
|
vfslide1down.vf v24, v20, fa2
|
|
vfmacc.vv v4, v18, v22
|
|
vfslide1down.vf v26, v22, fa3
|
|
vfmacc.vv v6, v16, v22
|
|
vfmv.f.s fa0, v16
|
|
vfmacc.vv v8, v16, v24
|
|
vfmv.f.s fa1, v18
|
|
vfmacc.vv v10, v16, v26
|
|
vfmv.f.s fa2, v20
|
|
vfnmsac.vv v6, v18, v20
|
|
vfmv.f.s fa3, v22
|
|
vfmacc.vv v8, v18, v26
|
|
vfnmsac.vv v10, v18, v24
|
|
bnez a2, 1b
|
|
|
|
vsetvli t0, zero, e32, m2, ta, ma
|
|
vfredusum.vs v0, v0, v2
|
|
vfredusum.vs v4, v4, v2
|
|
vfmv.f.s fa0, v0
|
|
vfredusum.vs v6, v6, v2
|
|
vfmv.f.s fa2, v4
|
|
fadd.s ft4, ft4, fa0
|
|
vfredusum.vs v8, v8, v2
|
|
vfmv.f.s fa3, v6
|
|
fadd.s ft0, ft0, fa2
|
|
vfredusum.vs v10, v10, v2
|
|
vfmv.f.s fa4, v8
|
|
fadd.s ft1, ft1, fa3
|
|
vfmv.f.s fa5, v10
|
|
fsw ft0, (a1)
|
|
fadd.s ft2, ft2, fa4
|
|
fsw ft1, 4(a1)
|
|
fadd.s ft3, ft3, fa5
|
|
fsw ft2, 8(a1)
|
|
fadd.s ft6, ft6, fa2
|
|
fsw ft3, 12(a1)
|
|
fadd.s ft7, ft7, fa3
|
|
fsw ft4, 16(a1)
|
|
fadd.s ft10, ft10, fa0
|
|
fsw ft6, 24(a1)
|
|
fsw ft7, 28(a1)
|
|
fsw ft10, 40(a1)
|
|
ret
|
|
endfunc
|
|
|
|
func ff_sbr_hf_gen_rvv, zve32f
|
|
NOHWF fmv.w.x fa0, a4
|
|
NOHWF mv a4, a5
|
|
NOHWF mv a5, a6
|
|
flw ft2, 0(a2)
|
|
fmul.s fa1, fa0, fa0 // bw * bw
|
|
sh3add a1, a5, a1
|
|
flw ft3, 4(a2)
|
|
fmul.s fa2, ft2, fa0 // alpha[2]
|
|
sh3add a0, a5, a0
|
|
flw ft0, 0(a3)
|
|
fmul.s fa3, ft3, fa0 // alpha[3]
|
|
sub a5, a5, a4
|
|
flw ft1, 4(a3)
|
|
fmul.s fa0, ft0, fa1 // alpha[0]
|
|
flw ft0, -16(a1) // X_low[end - 2][0]
|
|
fmul.s fa1, ft1, fa1 // alpha[1]
|
|
flw ft1, -12(a1) // X_low[end - 2][1]
|
|
flw ft2, -8(a1) // X_low[end - 1][0]
|
|
flw ft3, -4(a1) // X_low[end - 1][1]
|
|
addi a1, a1, -16
|
|
1:
|
|
vsetvli t0, a5, e32, m4, ta, ma
|
|
slli t1, t0, 3
|
|
sub a1, a1, t1
|
|
vlseg2e32.v v0, (a1) // X_low[i - 2]
|
|
sub a0, a0, t1
|
|
vfslide1down.vf v8, v0, ft0 // X_low[i - 1][0]
|
|
sub a5, a5, t0
|
|
vfslide1down.vf v12, v4, ft1 // X_low[i - 1][1]
|
|
vfslide1down.vf v16, v8, ft2 // X_low[i ][0]
|
|
vfslide1down.vf v20, v12, ft3 // X_low[i ][1]
|
|
vfmacc.vf v16, fa0, v0
|
|
vfmacc.vf v20, fa0, v4
|
|
vfmv.f.s ft0, v0
|
|
vfnmsac.vf v16, fa1, v4
|
|
vfmacc.vf v20, fa1, v0
|
|
vfmv.f.s ft1, v4
|
|
vfmacc.vf v16, fa2, v8
|
|
vfmacc.vf v20, fa2, v12
|
|
vfmv.f.s ft2, v8
|
|
vfnmsac.vf v16, fa3, v12
|
|
vfmacc.vf v20, fa3, v8
|
|
vfmv.f.s ft3, v12
|
|
vsseg2e32.v v16, (a0)
|
|
bnez a5, 1b
|
|
|
|
ret
|
|
endfunc
|
|
|
|
func ff_sbr_hf_g_filt_rvv, zve32f
|
|
li t1, 40 * 2 * 4
|
|
sh3add a1, a4, a1
|
|
1:
|
|
vsetvli t0, a3, e32, m4, ta, ma
|
|
vlsseg2e32.v v16, (a1), t1
|
|
mul t2, t0, t1
|
|
vle32.v v8, (a2)
|
|
sub a3, a3, t0
|
|
vfmul.vv v16, v16, v8
|
|
add a1, t2, a1
|
|
vfmul.vv v20, v20, v8
|
|
sh2add a2, t0, a2
|
|
vsseg2e32.v v16, (a0)
|
|
sh3add a0, t0, a0
|
|
bnez a3, 1b
|
|
|
|
ret
|
|
endfunc
|
|
|
|
.macro hf_apply_noise n
|
|
lla a6, ff_sbr_noise_table
|
|
fmv.s.x ft0, zero
|
|
addi a6, a6, 8
|
|
1:
|
|
.if \n & 1
|
|
min t0, t0, a5 // preserve parity of t0 for v4 sign injector
|
|
vsetvli zero, t0, e32, m4, ta, mu
|
|
.else
|
|
vsetvli t0, a5, e32, m4, ta, mu
|
|
.endif
|
|
sh3add t6, a3, a6
|
|
vle32.v v8, (a1) // s_m
|
|
sub a5, a5, t0
|
|
vle32.v v12, (a2) // q_filt
|
|
sh2add a1, t0, a1
|
|
vmfeq.vf v0, v8, ft0 // s_m == 0.f
|
|
vlseg2e32.v v24, (t6) // ff_sbr_noise_table
|
|
sh2add a2, t0, a2
|
|
.if \n == 2
|
|
vfneg.v v8, v8
|
|
.endif
|
|
.if \n & 1
|
|
vfsgnjx.vv v8, v8, v4 // could equivalent use vxor.vv
|
|
.endif
|
|
add a3, t0, a3
|
|
vlseg2e32.v v16, (a0) // Y
|
|
andi a3, a3, 0x1ff
|
|
.if \n & 1
|
|
vfmul.vv v28, v12, v28
|
|
vfmacc.vv v16, v12, v24, v0.t
|
|
vmerge.vvm v28, v8, v28, v0
|
|
vfadd.vv v20, v20, v28
|
|
.else
|
|
vfmul.vv v24, v12, v24
|
|
vfmacc.vv v20, v12, v28, v0.t
|
|
vmerge.vvm v24, v8, v24, v0
|
|
vfadd.vv v16, v16, v24
|
|
.endif
|
|
vsseg2e32.v v16, (a0)
|
|
sh3add a0, t0, a0
|
|
bnez a5, 1b
|
|
|
|
ret
|
|
.endm
|
|
|
|
func ff_sbr_hf_apply_noise_0_rvv, zve32f
|
|
hf_apply_noise 0
|
|
endfunc
|
|
|
|
func ff_sbr_hf_apply_noise_3_rvv, zve32f
|
|
not a4, a4 // invert parity of kx
|
|
// fall through
|
|
endfunc
|
|
|
|
func ff_sbr_hf_apply_noise_1_rvv, zve32f
|
|
vsetvli t0, zero, e32, m4, ta, ma
|
|
vid.v v4
|
|
vxor.vx v4, v4, a4
|
|
vsll.vi v4, v4, 31 // v4[i] = (kx & 1) ? -0.f : +0.f
|
|
hf_apply_noise 1
|
|
endfunc
|
|
|
|
func ff_sbr_hf_apply_noise_2_rvv, zve32f
|
|
hf_apply_noise 2
|
|
endfunc
|