xref: /aosp_15_r20/external/webp/src/dsp/dec_msa.c (revision b2055c353e87c8814eb2b6b1b11112a1562253bd)
1*b2055c35SXin Li // Copyright 2016 Google Inc. All Rights Reserved.
2*b2055c35SXin Li //
3*b2055c35SXin Li // Use of this source code is governed by a BSD-style license
4*b2055c35SXin Li // that can be found in the COPYING file in the root of the source
5*b2055c35SXin Li // tree. An additional intellectual property rights grant can be found
6*b2055c35SXin Li // in the file PATENTS. All contributing project authors may
7*b2055c35SXin Li // be found in the AUTHORS file in the root of the source tree.
8*b2055c35SXin Li // -----------------------------------------------------------------------------
9*b2055c35SXin Li //
10*b2055c35SXin Li // MSA version of dsp functions
11*b2055c35SXin Li //
12*b2055c35SXin Li // Author(s):  Prashant Patil   ([email protected])
13*b2055c35SXin Li 
14*b2055c35SXin Li 
15*b2055c35SXin Li #include "src/dsp/dsp.h"
16*b2055c35SXin Li 
17*b2055c35SXin Li #if defined(WEBP_USE_MSA)
18*b2055c35SXin Li 
19*b2055c35SXin Li #include "src/dsp/msa_macro.h"
20*b2055c35SXin Li 
21*b2055c35SXin Li //------------------------------------------------------------------------------
22*b2055c35SXin Li // Transforms
23*b2055c35SXin Li 
24*b2055c35SXin Li #define IDCT_1D_W(in0, in1, in2, in3, out0, out1, out2, out3) {  \
25*b2055c35SXin Li   v4i32 a1_m, b1_m, c1_m, d1_m;                                  \
26*b2055c35SXin Li   v4i32 c_tmp1_m, c_tmp2_m, d_tmp1_m, d_tmp2_m;                  \
27*b2055c35SXin Li   const v4i32 cospi8sqrt2minus1 = __msa_fill_w(20091);           \
28*b2055c35SXin Li   const v4i32 sinpi8sqrt2 = __msa_fill_w(35468);                 \
29*b2055c35SXin Li                                                                  \
30*b2055c35SXin Li   a1_m = in0 + in2;                                              \
31*b2055c35SXin Li   b1_m = in0 - in2;                                              \
32*b2055c35SXin Li   c_tmp1_m = (in1 * sinpi8sqrt2) >> 16;                          \
33*b2055c35SXin Li   c_tmp2_m = in3 + ((in3 * cospi8sqrt2minus1) >> 16);            \
34*b2055c35SXin Li   c1_m = c_tmp1_m - c_tmp2_m;                                    \
35*b2055c35SXin Li   d_tmp1_m = in1 + ((in1 * cospi8sqrt2minus1) >> 16);            \
36*b2055c35SXin Li   d_tmp2_m = (in3 * sinpi8sqrt2) >> 16;                          \
37*b2055c35SXin Li   d1_m = d_tmp1_m + d_tmp2_m;                                    \
38*b2055c35SXin Li   BUTTERFLY_4(a1_m, b1_m, c1_m, d1_m, out0, out1, out2, out3);   \
39*b2055c35SXin Li }
40*b2055c35SXin Li 
TransformOne(const int16_t * in,uint8_t * dst)41*b2055c35SXin Li static void TransformOne(const int16_t* in, uint8_t* dst) {
42*b2055c35SXin Li   v8i16 input0, input1;
43*b2055c35SXin Li   v4i32 in0, in1, in2, in3, hz0, hz1, hz2, hz3, vt0, vt1, vt2, vt3;
44*b2055c35SXin Li   v4i32 res0, res1, res2, res3;
45*b2055c35SXin Li   const v16i8 zero = { 0 };
46*b2055c35SXin Li   v16i8 dest0, dest1, dest2, dest3;
47*b2055c35SXin Li 
48*b2055c35SXin Li   LD_SH2(in, 8, input0, input1);
49*b2055c35SXin Li   UNPCK_SH_SW(input0, in0, in1);
50*b2055c35SXin Li   UNPCK_SH_SW(input1, in2, in3);
51*b2055c35SXin Li   IDCT_1D_W(in0, in1, in2, in3, hz0, hz1, hz2, hz3);
52*b2055c35SXin Li   TRANSPOSE4x4_SW_SW(hz0, hz1, hz2, hz3, hz0, hz1, hz2, hz3);
53*b2055c35SXin Li   IDCT_1D_W(hz0, hz1, hz2, hz3, vt0, vt1, vt2, vt3);
54*b2055c35SXin Li   SRARI_W4_SW(vt0, vt1, vt2, vt3, 3);
55*b2055c35SXin Li   TRANSPOSE4x4_SW_SW(vt0, vt1, vt2, vt3, vt0, vt1, vt2, vt3);
56*b2055c35SXin Li   LD_SB4(dst, BPS, dest0, dest1, dest2, dest3);
57*b2055c35SXin Li   ILVR_B4_SW(zero, dest0, zero, dest1, zero, dest2, zero, dest3,
58*b2055c35SXin Li              res0, res1, res2, res3);
59*b2055c35SXin Li   ILVR_H4_SW(zero, res0, zero, res1, zero, res2, zero, res3,
60*b2055c35SXin Li              res0, res1, res2, res3);
61*b2055c35SXin Li   ADD4(res0, vt0, res1, vt1, res2, vt2, res3, vt3, res0, res1, res2, res3);
62*b2055c35SXin Li   CLIP_SW4_0_255(res0, res1, res2, res3);
63*b2055c35SXin Li   PCKEV_B2_SW(res0, res1, res2, res3, vt0, vt1);
64*b2055c35SXin Li   res0 = (v4i32)__msa_pckev_b((v16i8)vt0, (v16i8)vt1);
65*b2055c35SXin Li   ST4x4_UB(res0, res0, 3, 2, 1, 0, dst, BPS);
66*b2055c35SXin Li }
67*b2055c35SXin Li 
TransformTwo(const int16_t * in,uint8_t * dst,int do_two)68*b2055c35SXin Li static void TransformTwo(const int16_t* in, uint8_t* dst, int do_two) {
69*b2055c35SXin Li   TransformOne(in, dst);
70*b2055c35SXin Li   if (do_two) {
71*b2055c35SXin Li     TransformOne(in + 16, dst + 4);
72*b2055c35SXin Li   }
73*b2055c35SXin Li }
74*b2055c35SXin Li 
TransformWHT(const int16_t * in,int16_t * out)75*b2055c35SXin Li static void TransformWHT(const int16_t* in, int16_t* out) {
76*b2055c35SXin Li   v8i16 input0, input1;
77*b2055c35SXin Li   const v8i16 mask0 = { 0, 1, 2, 3, 8, 9, 10, 11 };
78*b2055c35SXin Li   const v8i16 mask1 = { 4, 5, 6, 7, 12, 13, 14, 15 };
79*b2055c35SXin Li   const v8i16 mask2 = { 0, 4, 8, 12, 1, 5, 9, 13 };
80*b2055c35SXin Li   const v8i16 mask3 = { 3, 7, 11, 15, 2, 6, 10, 14 };
81*b2055c35SXin Li   v8i16 tmp0, tmp1, tmp2, tmp3;
82*b2055c35SXin Li   v8i16 out0, out1;
83*b2055c35SXin Li 
84*b2055c35SXin Li   LD_SH2(in, 8, input0, input1);
85*b2055c35SXin Li   input1 = SLDI_SH(input1, input1, 8);
86*b2055c35SXin Li   tmp0 = input0 + input1;
87*b2055c35SXin Li   tmp1 = input0 - input1;
88*b2055c35SXin Li   VSHF_H2_SH(tmp0, tmp1, tmp0, tmp1, mask0, mask1, tmp2, tmp3);
89*b2055c35SXin Li   out0 = tmp2 + tmp3;
90*b2055c35SXin Li   out1 = tmp2 - tmp3;
91*b2055c35SXin Li   VSHF_H2_SH(out0, out1, out0, out1, mask2, mask3, input0, input1);
92*b2055c35SXin Li   tmp0 = input0 + input1;
93*b2055c35SXin Li   tmp1 = input0 - input1;
94*b2055c35SXin Li   VSHF_H2_SH(tmp0, tmp1, tmp0, tmp1, mask0, mask1, tmp2, tmp3);
95*b2055c35SXin Li   tmp0 = tmp2 + tmp3;
96*b2055c35SXin Li   tmp1 = tmp2 - tmp3;
97*b2055c35SXin Li   ADDVI_H2_SH(tmp0, 3, tmp1, 3, out0, out1);
98*b2055c35SXin Li   SRAI_H2_SH(out0, out1, 3);
99*b2055c35SXin Li   out[0] = __msa_copy_s_h(out0, 0);
100*b2055c35SXin Li   out[16] = __msa_copy_s_h(out0, 4);
101*b2055c35SXin Li   out[32] = __msa_copy_s_h(out1, 0);
102*b2055c35SXin Li   out[48] = __msa_copy_s_h(out1, 4);
103*b2055c35SXin Li   out[64] = __msa_copy_s_h(out0, 1);
104*b2055c35SXin Li   out[80] = __msa_copy_s_h(out0, 5);
105*b2055c35SXin Li   out[96] = __msa_copy_s_h(out1, 1);
106*b2055c35SXin Li   out[112] = __msa_copy_s_h(out1, 5);
107*b2055c35SXin Li   out[128] = __msa_copy_s_h(out0, 2);
108*b2055c35SXin Li   out[144] = __msa_copy_s_h(out0, 6);
109*b2055c35SXin Li   out[160] = __msa_copy_s_h(out1, 2);
110*b2055c35SXin Li   out[176] = __msa_copy_s_h(out1, 6);
111*b2055c35SXin Li   out[192] = __msa_copy_s_h(out0, 3);
112*b2055c35SXin Li   out[208] = __msa_copy_s_h(out0, 7);
113*b2055c35SXin Li   out[224] = __msa_copy_s_h(out1, 3);
114*b2055c35SXin Li   out[240] = __msa_copy_s_h(out1, 7);
115*b2055c35SXin Li }
116*b2055c35SXin Li 
TransformDC(const int16_t * in,uint8_t * dst)117*b2055c35SXin Li static void TransformDC(const int16_t* in, uint8_t* dst) {
118*b2055c35SXin Li   const int DC = (in[0] + 4) >> 3;
119*b2055c35SXin Li   const v8i16 tmp0 = __msa_fill_h(DC);
120*b2055c35SXin Li   ADDBLK_ST4x4_UB(tmp0, tmp0, tmp0, tmp0, dst, BPS);
121*b2055c35SXin Li }
122*b2055c35SXin Li 
TransformAC3(const int16_t * in,uint8_t * dst)123*b2055c35SXin Li static void TransformAC3(const int16_t* in, uint8_t* dst) {
124*b2055c35SXin Li   const int a = in[0] + 4;
125*b2055c35SXin Li   const int c4 = WEBP_TRANSFORM_AC3_MUL2(in[4]);
126*b2055c35SXin Li   const int d4 = WEBP_TRANSFORM_AC3_MUL1(in[4]);
127*b2055c35SXin Li   const int in2 = WEBP_TRANSFORM_AC3_MUL2(in[1]);
128*b2055c35SXin Li   const int in3 = WEBP_TRANSFORM_AC3_MUL1(in[1]);
129*b2055c35SXin Li   v4i32 tmp0 = { 0 };
130*b2055c35SXin Li   v4i32 out0 = __msa_fill_w(a + d4);
131*b2055c35SXin Li   v4i32 out1 = __msa_fill_w(a + c4);
132*b2055c35SXin Li   v4i32 out2 = __msa_fill_w(a - c4);
133*b2055c35SXin Li   v4i32 out3 = __msa_fill_w(a - d4);
134*b2055c35SXin Li   v4i32 res0, res1, res2, res3;
135*b2055c35SXin Li   const v4i32 zero = { 0 };
136*b2055c35SXin Li   v16u8 dest0, dest1, dest2, dest3;
137*b2055c35SXin Li 
138*b2055c35SXin Li   INSERT_W4_SW(in3, in2, -in2, -in3, tmp0);
139*b2055c35SXin Li   ADD4(out0, tmp0, out1, tmp0, out2, tmp0, out3, tmp0,
140*b2055c35SXin Li        out0, out1, out2, out3);
141*b2055c35SXin Li   SRAI_W4_SW(out0, out1, out2, out3, 3);
142*b2055c35SXin Li   LD_UB4(dst, BPS, dest0, dest1, dest2, dest3);
143*b2055c35SXin Li   ILVR_B4_SW(zero, dest0, zero, dest1, zero, dest2, zero, dest3,
144*b2055c35SXin Li              res0, res1, res2, res3);
145*b2055c35SXin Li   ILVR_H4_SW(zero, res0, zero, res1, zero, res2, zero, res3,
146*b2055c35SXin Li              res0, res1, res2, res3);
147*b2055c35SXin Li   ADD4(res0, out0, res1, out1, res2, out2, res3, out3, res0, res1, res2, res3);
148*b2055c35SXin Li   CLIP_SW4_0_255(res0, res1, res2, res3);
149*b2055c35SXin Li   PCKEV_B2_SW(res0, res1, res2, res3, out0, out1);
150*b2055c35SXin Li   res0 = (v4i32)__msa_pckev_b((v16i8)out0, (v16i8)out1);
151*b2055c35SXin Li   ST4x4_UB(res0, res0, 3, 2, 1, 0, dst, BPS);
152*b2055c35SXin Li }
153*b2055c35SXin Li 
154*b2055c35SXin Li //------------------------------------------------------------------------------
155*b2055c35SXin Li // Edge filtering functions
156*b2055c35SXin Li 
157*b2055c35SXin Li #define FLIP_SIGN2(in0, in1, out0, out1) {  \
158*b2055c35SXin Li   out0 = (v16i8)__msa_xori_b(in0, 0x80);    \
159*b2055c35SXin Li   out1 = (v16i8)__msa_xori_b(in1, 0x80);    \
160*b2055c35SXin Li }
161*b2055c35SXin Li 
162*b2055c35SXin Li #define FLIP_SIGN4(in0, in1, in2, in3, out0, out1, out2, out3) {  \
163*b2055c35SXin Li   FLIP_SIGN2(in0, in1, out0, out1);                               \
164*b2055c35SXin Li   FLIP_SIGN2(in2, in3, out2, out3);                               \
165*b2055c35SXin Li }
166*b2055c35SXin Li 
167*b2055c35SXin Li #define FILT_VAL(q0_m, p0_m, mask, filt) do {  \
168*b2055c35SXin Li   v16i8 q0_sub_p0;                             \
169*b2055c35SXin Li   q0_sub_p0 = __msa_subs_s_b(q0_m, p0_m);      \
170*b2055c35SXin Li   filt = __msa_adds_s_b(filt, q0_sub_p0);      \
171*b2055c35SXin Li   filt = __msa_adds_s_b(filt, q0_sub_p0);      \
172*b2055c35SXin Li   filt = __msa_adds_s_b(filt, q0_sub_p0);      \
173*b2055c35SXin Li   filt = filt & mask;                          \
174*b2055c35SXin Li } while (0)
175*b2055c35SXin Li 
176*b2055c35SXin Li #define FILT2(q_m, p_m, q, p) do {            \
177*b2055c35SXin Li   u_r = SRAI_H(temp1, 7);                     \
178*b2055c35SXin Li   u_r = __msa_sat_s_h(u_r, 7);                \
179*b2055c35SXin Li   u_l = SRAI_H(temp3, 7);                     \
180*b2055c35SXin Li   u_l = __msa_sat_s_h(u_l, 7);                \
181*b2055c35SXin Li   u = __msa_pckev_b((v16i8)u_l, (v16i8)u_r);  \
182*b2055c35SXin Li   q_m = __msa_subs_s_b(q_m, u);               \
183*b2055c35SXin Li   p_m = __msa_adds_s_b(p_m, u);               \
184*b2055c35SXin Li   q = __msa_xori_b((v16u8)q_m, 0x80);         \
185*b2055c35SXin Li   p = __msa_xori_b((v16u8)p_m, 0x80);         \
186*b2055c35SXin Li } while (0)
187*b2055c35SXin Li 
188*b2055c35SXin Li #define LPF_FILTER4_4W(p1, p0, q0, q1, mask, hev) do {  \
189*b2055c35SXin Li   v16i8 p1_m, p0_m, q0_m, q1_m;                         \
190*b2055c35SXin Li   v16i8 filt, t1, t2;                                   \
191*b2055c35SXin Li   const v16i8 cnst4b = __msa_ldi_b(4);                  \
192*b2055c35SXin Li   const v16i8 cnst3b = __msa_ldi_b(3);                  \
193*b2055c35SXin Li                                                         \
194*b2055c35SXin Li   FLIP_SIGN4(p1, p0, q0, q1, p1_m, p0_m, q0_m, q1_m);   \
195*b2055c35SXin Li   filt = __msa_subs_s_b(p1_m, q1_m);                    \
196*b2055c35SXin Li   filt = filt & hev;                                    \
197*b2055c35SXin Li   FILT_VAL(q0_m, p0_m, mask, filt);                     \
198*b2055c35SXin Li   t1 = __msa_adds_s_b(filt, cnst4b);                    \
199*b2055c35SXin Li   t1 = SRAI_B(t1, 3);                                   \
200*b2055c35SXin Li   t2 = __msa_adds_s_b(filt, cnst3b);                    \
201*b2055c35SXin Li   t2 = SRAI_B(t2, 3);                                   \
202*b2055c35SXin Li   q0_m = __msa_subs_s_b(q0_m, t1);                      \
203*b2055c35SXin Li   q0 = __msa_xori_b((v16u8)q0_m, 0x80);                 \
204*b2055c35SXin Li   p0_m = __msa_adds_s_b(p0_m, t2);                      \
205*b2055c35SXin Li   p0 = __msa_xori_b((v16u8)p0_m, 0x80);                 \
206*b2055c35SXin Li   filt = __msa_srari_b(t1, 1);                          \
207*b2055c35SXin Li   hev = __msa_xori_b(hev, 0xff);                        \
208*b2055c35SXin Li   filt = filt & hev;                                    \
209*b2055c35SXin Li   q1_m = __msa_subs_s_b(q1_m, filt);                    \
210*b2055c35SXin Li   q1 = __msa_xori_b((v16u8)q1_m, 0x80);                 \
211*b2055c35SXin Li   p1_m = __msa_adds_s_b(p1_m, filt);                    \
212*b2055c35SXin Li   p1 = __msa_xori_b((v16u8)p1_m, 0x80);                 \
213*b2055c35SXin Li } while (0)
214*b2055c35SXin Li 
215*b2055c35SXin Li #define LPF_MBFILTER(p2, p1, p0, q0, q1, q2, mask, hev) do {  \
216*b2055c35SXin Li   v16i8 p2_m, p1_m, p0_m, q2_m, q1_m, q0_m;                   \
217*b2055c35SXin Li   v16i8 u, filt, t1, t2, filt_sign;                           \
218*b2055c35SXin Li   v8i16 filt_r, filt_l, u_r, u_l;                             \
219*b2055c35SXin Li   v8i16 temp0, temp1, temp2, temp3;                           \
220*b2055c35SXin Li   const v16i8 cnst4b = __msa_ldi_b(4);                        \
221*b2055c35SXin Li   const v16i8 cnst3b = __msa_ldi_b(3);                        \
222*b2055c35SXin Li   const v8i16 cnst9h = __msa_ldi_h(9);                        \
223*b2055c35SXin Li   const v8i16 cnst63h = __msa_ldi_h(63);                      \
224*b2055c35SXin Li                                                               \
225*b2055c35SXin Li   FLIP_SIGN4(p1, p0, q0, q1, p1_m, p0_m, q0_m, q1_m);         \
226*b2055c35SXin Li   filt = __msa_subs_s_b(p1_m, q1_m);                          \
227*b2055c35SXin Li   FILT_VAL(q0_m, p0_m, mask, filt);                           \
228*b2055c35SXin Li   FLIP_SIGN2(p2, q2, p2_m, q2_m);                             \
229*b2055c35SXin Li   t2 = filt & hev;                                            \
230*b2055c35SXin Li   /* filt_val &= ~hev */                                      \
231*b2055c35SXin Li   hev = __msa_xori_b(hev, 0xff);                              \
232*b2055c35SXin Li   filt = filt & hev;                                          \
233*b2055c35SXin Li   t1 = __msa_adds_s_b(t2, cnst4b);                            \
234*b2055c35SXin Li   t1 = SRAI_B(t1, 3);                                         \
235*b2055c35SXin Li   t2 = __msa_adds_s_b(t2, cnst3b);                            \
236*b2055c35SXin Li   t2 = SRAI_B(t2, 3);                                         \
237*b2055c35SXin Li   q0_m = __msa_subs_s_b(q0_m, t1);                            \
238*b2055c35SXin Li   p0_m = __msa_adds_s_b(p0_m, t2);                            \
239*b2055c35SXin Li   filt_sign = __msa_clti_s_b(filt, 0);                        \
240*b2055c35SXin Li   ILVRL_B2_SH(filt_sign, filt, filt_r, filt_l);               \
241*b2055c35SXin Li   /* update q2/p2 */                                          \
242*b2055c35SXin Li   temp0 = filt_r * cnst9h;                                    \
243*b2055c35SXin Li   temp1 = temp0 + cnst63h;                                    \
244*b2055c35SXin Li   temp2 = filt_l * cnst9h;                                    \
245*b2055c35SXin Li   temp3 = temp2 + cnst63h;                                    \
246*b2055c35SXin Li   FILT2(q2_m, p2_m, q2, p2);                                  \
247*b2055c35SXin Li   /* update q1/p1 */                                          \
248*b2055c35SXin Li   temp1 = temp1 + temp0;                                      \
249*b2055c35SXin Li   temp3 = temp3 + temp2;                                      \
250*b2055c35SXin Li   FILT2(q1_m, p1_m, q1, p1);                                  \
251*b2055c35SXin Li   /* update q0/p0 */                                          \
252*b2055c35SXin Li   temp1 = temp1 + temp0;                                      \
253*b2055c35SXin Li   temp3 = temp3 + temp2;                                      \
254*b2055c35SXin Li   FILT2(q0_m, p0_m, q0, p0);                                  \
255*b2055c35SXin Li } while (0)
256*b2055c35SXin Li 
257*b2055c35SXin Li #define LPF_MASK_HEV(p3_in, p2_in, p1_in, p0_in,                 \
258*b2055c35SXin Li                      q0_in, q1_in, q2_in, q3_in,                 \
259*b2055c35SXin Li                      limit_in, b_limit_in, thresh_in,            \
260*b2055c35SXin Li                      hev_out, mask_out) do {                     \
261*b2055c35SXin Li   v16u8 p3_asub_p2_m, p2_asub_p1_m, p1_asub_p0_m, q1_asub_q0_m;  \
262*b2055c35SXin Li   v16u8 p1_asub_q1_m, p0_asub_q0_m, q3_asub_q2_m, q2_asub_q1_m;  \
263*b2055c35SXin Li   v16u8 flat_out;                                                \
264*b2055c35SXin Li                                                                  \
265*b2055c35SXin Li   /* absolute subtraction of pixel values */                     \
266*b2055c35SXin Li   p3_asub_p2_m = __msa_asub_u_b(p3_in, p2_in);                   \
267*b2055c35SXin Li   p2_asub_p1_m = __msa_asub_u_b(p2_in, p1_in);                   \
268*b2055c35SXin Li   p1_asub_p0_m = __msa_asub_u_b(p1_in, p0_in);                   \
269*b2055c35SXin Li   q1_asub_q0_m = __msa_asub_u_b(q1_in, q0_in);                   \
270*b2055c35SXin Li   q2_asub_q1_m = __msa_asub_u_b(q2_in, q1_in);                   \
271*b2055c35SXin Li   q3_asub_q2_m = __msa_asub_u_b(q3_in, q2_in);                   \
272*b2055c35SXin Li   p0_asub_q0_m = __msa_asub_u_b(p0_in, q0_in);                   \
273*b2055c35SXin Li   p1_asub_q1_m = __msa_asub_u_b(p1_in, q1_in);                   \
274*b2055c35SXin Li   /* calculation of hev */                                       \
275*b2055c35SXin Li   flat_out = __msa_max_u_b(p1_asub_p0_m, q1_asub_q0_m);          \
276*b2055c35SXin Li   hev_out = (thresh_in < flat_out);                              \
277*b2055c35SXin Li   /* calculation of mask */                                      \
278*b2055c35SXin Li   p0_asub_q0_m = __msa_adds_u_b(p0_asub_q0_m, p0_asub_q0_m);     \
279*b2055c35SXin Li   p1_asub_q1_m = SRAI_B(p1_asub_q1_m, 1);                        \
280*b2055c35SXin Li   p0_asub_q0_m = __msa_adds_u_b(p0_asub_q0_m, p1_asub_q1_m);     \
281*b2055c35SXin Li   mask_out = (b_limit_in < p0_asub_q0_m);                        \
282*b2055c35SXin Li   mask_out = __msa_max_u_b(flat_out, mask_out);                  \
283*b2055c35SXin Li   p3_asub_p2_m = __msa_max_u_b(p3_asub_p2_m, p2_asub_p1_m);      \
284*b2055c35SXin Li   mask_out = __msa_max_u_b(p3_asub_p2_m, mask_out);              \
285*b2055c35SXin Li   q2_asub_q1_m = __msa_max_u_b(q2_asub_q1_m, q3_asub_q2_m);      \
286*b2055c35SXin Li   mask_out = __msa_max_u_b(q2_asub_q1_m, mask_out);              \
287*b2055c35SXin Li   mask_out = (limit_in < mask_out);                              \
288*b2055c35SXin Li   mask_out = __msa_xori_b(mask_out, 0xff);                       \
289*b2055c35SXin Li } while (0)
290*b2055c35SXin Li 
291*b2055c35SXin Li #define ST6x1_UB(in0, in0_idx, in1, in1_idx, pdst, stride) do { \
292*b2055c35SXin Li   const uint16_t tmp0_h = __msa_copy_s_h((v8i16)in1, in1_idx);  \
293*b2055c35SXin Li   const uint32_t tmp0_w = __msa_copy_s_w((v4i32)in0, in0_idx);  \
294*b2055c35SXin Li   SW(tmp0_w, pdst);                                             \
295*b2055c35SXin Li   SH(tmp0_h, pdst + stride);                                    \
296*b2055c35SXin Li } while (0)
297*b2055c35SXin Li 
298*b2055c35SXin Li #define ST6x4_UB(in0, start_in0_idx, in1, start_in1_idx, pdst, stride) do { \
299*b2055c35SXin Li   uint8_t* ptmp1 = (uint8_t*)pdst;                                          \
300*b2055c35SXin Li   ST6x1_UB(in0, start_in0_idx, in1, start_in1_idx, ptmp1, 4);               \
301*b2055c35SXin Li   ptmp1 += stride;                                                          \
302*b2055c35SXin Li   ST6x1_UB(in0, start_in0_idx + 1, in1, start_in1_idx + 1, ptmp1, 4);       \
303*b2055c35SXin Li   ptmp1 += stride;                                                          \
304*b2055c35SXin Li   ST6x1_UB(in0, start_in0_idx + 2, in1, start_in1_idx + 2, ptmp1, 4);       \
305*b2055c35SXin Li   ptmp1 += stride;                                                          \
306*b2055c35SXin Li   ST6x1_UB(in0, start_in0_idx + 3, in1, start_in1_idx + 3, ptmp1, 4);       \
307*b2055c35SXin Li } while (0)
308*b2055c35SXin Li 
309*b2055c35SXin Li #define LPF_SIMPLE_FILT(p1_in, p0_in, q0_in, q1_in, mask) do {       \
310*b2055c35SXin Li     v16i8 p1_m, p0_m, q0_m, q1_m, filt, filt1, filt2;                \
311*b2055c35SXin Li     const v16i8 cnst4b = __msa_ldi_b(4);                             \
312*b2055c35SXin Li     const v16i8 cnst3b =  __msa_ldi_b(3);                            \
313*b2055c35SXin Li                                                                      \
314*b2055c35SXin Li     FLIP_SIGN4(p1_in, p0_in, q0_in, q1_in, p1_m, p0_m, q0_m, q1_m);  \
315*b2055c35SXin Li     filt = __msa_subs_s_b(p1_m, q1_m);                               \
316*b2055c35SXin Li     FILT_VAL(q0_m, p0_m, mask, filt);                                \
317*b2055c35SXin Li     filt1 = __msa_adds_s_b(filt, cnst4b);                            \
318*b2055c35SXin Li     filt1 = SRAI_B(filt1, 3);                                        \
319*b2055c35SXin Li     filt2 = __msa_adds_s_b(filt, cnst3b);                            \
320*b2055c35SXin Li     filt2 = SRAI_B(filt2, 3);                                        \
321*b2055c35SXin Li     q0_m = __msa_subs_s_b(q0_m, filt1);                              \
322*b2055c35SXin Li     p0_m = __msa_adds_s_b(p0_m, filt2);                              \
323*b2055c35SXin Li     q0_in = __msa_xori_b((v16u8)q0_m, 0x80);                         \
324*b2055c35SXin Li     p0_in = __msa_xori_b((v16u8)p0_m, 0x80);                         \
325*b2055c35SXin Li } while (0)
326*b2055c35SXin Li 
327*b2055c35SXin Li #define LPF_SIMPLE_MASK(p1, p0, q0, q1, b_limit, mask) do {    \
328*b2055c35SXin Li     v16u8 p1_a_sub_q1, p0_a_sub_q0;                            \
329*b2055c35SXin Li                                                                \
330*b2055c35SXin Li     p0_a_sub_q0 = __msa_asub_u_b(p0, q0);                      \
331*b2055c35SXin Li     p1_a_sub_q1 = __msa_asub_u_b(p1, q1);                      \
332*b2055c35SXin Li     p1_a_sub_q1 = (v16u8)__msa_srli_b((v16i8)p1_a_sub_q1, 1);  \
333*b2055c35SXin Li     p0_a_sub_q0 = __msa_adds_u_b(p0_a_sub_q0, p0_a_sub_q0);    \
334*b2055c35SXin Li     mask = __msa_adds_u_b(p0_a_sub_q0, p1_a_sub_q1);           \
335*b2055c35SXin Li     mask = (mask <= b_limit);                                  \
336*b2055c35SXin Li } while (0)
337*b2055c35SXin Li 
VFilter16(uint8_t * src,int stride,int b_limit_in,int limit_in,int thresh_in)338*b2055c35SXin Li static void VFilter16(uint8_t* src, int stride,
339*b2055c35SXin Li                       int b_limit_in, int limit_in, int thresh_in) {
340*b2055c35SXin Li   uint8_t* ptemp = src - 4 * stride;
341*b2055c35SXin Li   v16u8 p3, p2, p1, p0, q3, q2, q1, q0;
342*b2055c35SXin Li   v16u8 mask, hev;
343*b2055c35SXin Li   const v16u8 thresh = (v16u8)__msa_fill_b(thresh_in);
344*b2055c35SXin Li   const v16u8 limit = (v16u8)__msa_fill_b(limit_in);
345*b2055c35SXin Li   const v16u8 b_limit = (v16u8)__msa_fill_b(b_limit_in);
346*b2055c35SXin Li 
347*b2055c35SXin Li   LD_UB8(ptemp, stride, p3, p2, p1, p0, q0, q1, q2, q3);
348*b2055c35SXin Li   LPF_MASK_HEV(p3, p2, p1, p0, q0, q1, q2, q3, limit, b_limit, thresh,
349*b2055c35SXin Li                hev, mask);
350*b2055c35SXin Li   LPF_MBFILTER(p2, p1, p0, q0, q1, q2, mask, hev);
351*b2055c35SXin Li   ptemp = src - 3 * stride;
352*b2055c35SXin Li   ST_UB4(p2, p1, p0, q0, ptemp, stride);
353*b2055c35SXin Li   ptemp += (4 * stride);
354*b2055c35SXin Li   ST_UB2(q1, q2, ptemp, stride);
355*b2055c35SXin Li }
356*b2055c35SXin Li 
HFilter16(uint8_t * src,int stride,int b_limit_in,int limit_in,int thresh_in)357*b2055c35SXin Li static void HFilter16(uint8_t* src, int stride,
358*b2055c35SXin Li                       int b_limit_in, int limit_in, int thresh_in) {
359*b2055c35SXin Li   uint8_t* ptmp  = src - 4;
360*b2055c35SXin Li   v16u8 p3, p2, p1, p0, q3, q2, q1, q0;
361*b2055c35SXin Li   v16u8 mask, hev;
362*b2055c35SXin Li   v16u8 row0, row1, row2, row3, row4, row5, row6, row7, row8;
363*b2055c35SXin Li   v16u8 row9, row10, row11, row12, row13, row14, row15;
364*b2055c35SXin Li   v8i16 tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7;
365*b2055c35SXin Li   const v16u8 b_limit = (v16u8)__msa_fill_b(b_limit_in);
366*b2055c35SXin Li   const v16u8 limit = (v16u8)__msa_fill_b(limit_in);
367*b2055c35SXin Li   const v16u8 thresh = (v16u8)__msa_fill_b(thresh_in);
368*b2055c35SXin Li 
369*b2055c35SXin Li   LD_UB8(ptmp, stride, row0, row1, row2, row3, row4, row5, row6, row7);
370*b2055c35SXin Li   ptmp += (8 * stride);
371*b2055c35SXin Li   LD_UB8(ptmp, stride, row8, row9, row10, row11, row12, row13, row14, row15);
372*b2055c35SXin Li   TRANSPOSE16x8_UB_UB(row0, row1, row2, row3, row4, row5, row6, row7,
373*b2055c35SXin Li                       row8, row9, row10, row11, row12, row13, row14, row15,
374*b2055c35SXin Li                       p3, p2, p1, p0, q0, q1, q2, q3);
375*b2055c35SXin Li   LPF_MASK_HEV(p3, p2, p1, p0, q0, q1, q2, q3, limit, b_limit, thresh,
376*b2055c35SXin Li                hev, mask);
377*b2055c35SXin Li   LPF_MBFILTER(p2, p1, p0, q0, q1, q2, mask, hev);
378*b2055c35SXin Li   ILVR_B2_SH(p1, p2, q0, p0, tmp0, tmp1);
379*b2055c35SXin Li   ILVRL_H2_SH(tmp1, tmp0, tmp3, tmp4);
380*b2055c35SXin Li   ILVL_B2_SH(p1, p2, q0, p0, tmp0, tmp1);
381*b2055c35SXin Li   ILVRL_H2_SH(tmp1, tmp0, tmp6, tmp7);
382*b2055c35SXin Li   ILVRL_B2_SH(q2, q1, tmp2, tmp5);
383*b2055c35SXin Li   ptmp = src - 3;
384*b2055c35SXin Li   ST6x1_UB(tmp3, 0, tmp2, 0, ptmp, 4);
385*b2055c35SXin Li   ptmp += stride;
386*b2055c35SXin Li   ST6x1_UB(tmp3, 1, tmp2, 1, ptmp, 4);
387*b2055c35SXin Li   ptmp += stride;
388*b2055c35SXin Li   ST6x1_UB(tmp3, 2, tmp2, 2, ptmp, 4);
389*b2055c35SXin Li   ptmp += stride;
390*b2055c35SXin Li   ST6x1_UB(tmp3, 3, tmp2, 3, ptmp, 4);
391*b2055c35SXin Li   ptmp += stride;
392*b2055c35SXin Li   ST6x1_UB(tmp4, 0, tmp2, 4, ptmp, 4);
393*b2055c35SXin Li   ptmp += stride;
394*b2055c35SXin Li   ST6x1_UB(tmp4, 1, tmp2, 5, ptmp, 4);
395*b2055c35SXin Li   ptmp += stride;
396*b2055c35SXin Li   ST6x1_UB(tmp4, 2, tmp2, 6, ptmp, 4);
397*b2055c35SXin Li   ptmp += stride;
398*b2055c35SXin Li   ST6x1_UB(tmp4, 3, tmp2, 7, ptmp, 4);
399*b2055c35SXin Li   ptmp += stride;
400*b2055c35SXin Li   ST6x1_UB(tmp6, 0, tmp5, 0, ptmp, 4);
401*b2055c35SXin Li   ptmp += stride;
402*b2055c35SXin Li   ST6x1_UB(tmp6, 1, tmp5, 1, ptmp, 4);
403*b2055c35SXin Li   ptmp += stride;
404*b2055c35SXin Li   ST6x1_UB(tmp6, 2, tmp5, 2, ptmp, 4);
405*b2055c35SXin Li   ptmp += stride;
406*b2055c35SXin Li   ST6x1_UB(tmp6, 3, tmp5, 3, ptmp, 4);
407*b2055c35SXin Li   ptmp += stride;
408*b2055c35SXin Li   ST6x1_UB(tmp7, 0, tmp5, 4, ptmp, 4);
409*b2055c35SXin Li   ptmp += stride;
410*b2055c35SXin Li   ST6x1_UB(tmp7, 1, tmp5, 5, ptmp, 4);
411*b2055c35SXin Li   ptmp += stride;
412*b2055c35SXin Li   ST6x1_UB(tmp7, 2, tmp5, 6, ptmp, 4);
413*b2055c35SXin Li   ptmp += stride;
414*b2055c35SXin Li   ST6x1_UB(tmp7, 3, tmp5, 7, ptmp, 4);
415*b2055c35SXin Li }
416*b2055c35SXin Li 
417*b2055c35SXin Li // on three inner edges
VFilterHorEdge16i(uint8_t * src,int stride,int b_limit,int limit,int thresh)418*b2055c35SXin Li static void VFilterHorEdge16i(uint8_t* src, int stride,
419*b2055c35SXin Li                               int b_limit, int limit, int thresh) {
420*b2055c35SXin Li   v16u8 mask, hev;
421*b2055c35SXin Li   v16u8 p3, p2, p1, p0, q3, q2, q1, q0;
422*b2055c35SXin Li   const v16u8 thresh0 = (v16u8)__msa_fill_b(thresh);
423*b2055c35SXin Li   const v16u8 b_limit0 = (v16u8)__msa_fill_b(b_limit);
424*b2055c35SXin Li   const v16u8 limit0 = (v16u8)__msa_fill_b(limit);
425*b2055c35SXin Li 
426*b2055c35SXin Li   LD_UB8((src - 4 * stride), stride, p3, p2, p1, p0, q0, q1, q2, q3);
427*b2055c35SXin Li   LPF_MASK_HEV(p3, p2, p1, p0, q0, q1, q2, q3, limit0, b_limit0, thresh0,
428*b2055c35SXin Li                hev, mask);
429*b2055c35SXin Li   LPF_FILTER4_4W(p1, p0, q0, q1, mask, hev);
430*b2055c35SXin Li   ST_UB4(p1, p0, q0, q1, (src - 2 * stride), stride);
431*b2055c35SXin Li }
432*b2055c35SXin Li 
VFilter16i(uint8_t * src_y,int stride,int b_limit,int limit,int thresh)433*b2055c35SXin Li static void VFilter16i(uint8_t* src_y, int stride,
434*b2055c35SXin Li                        int b_limit, int limit, int thresh) {
435*b2055c35SXin Li   VFilterHorEdge16i(src_y +  4 * stride, stride, b_limit, limit, thresh);
436*b2055c35SXin Li   VFilterHorEdge16i(src_y +  8 * stride, stride, b_limit, limit, thresh);
437*b2055c35SXin Li   VFilterHorEdge16i(src_y + 12 * stride, stride, b_limit, limit, thresh);
438*b2055c35SXin Li }
439*b2055c35SXin Li 
HFilterVertEdge16i(uint8_t * src,int stride,int b_limit,int limit,int thresh)440*b2055c35SXin Li static void HFilterVertEdge16i(uint8_t* src, int stride,
441*b2055c35SXin Li                                int b_limit, int limit, int thresh) {
442*b2055c35SXin Li   v16u8 mask, hev;
443*b2055c35SXin Li   v16u8 p3, p2, p1, p0, q3, q2, q1, q0;
444*b2055c35SXin Li   v16u8 row0, row1, row2, row3, row4, row5, row6, row7;
445*b2055c35SXin Li   v16u8 row8, row9, row10, row11, row12, row13, row14, row15;
446*b2055c35SXin Li   v8i16 tmp0, tmp1, tmp2, tmp3, tmp4, tmp5;
447*b2055c35SXin Li   const v16u8 thresh0 = (v16u8)__msa_fill_b(thresh);
448*b2055c35SXin Li   const v16u8 b_limit0 = (v16u8)__msa_fill_b(b_limit);
449*b2055c35SXin Li   const v16u8 limit0 = (v16u8)__msa_fill_b(limit);
450*b2055c35SXin Li 
451*b2055c35SXin Li   LD_UB8(src - 4, stride, row0, row1, row2, row3, row4, row5, row6, row7);
452*b2055c35SXin Li   LD_UB8(src - 4 + (8 * stride), stride,
453*b2055c35SXin Li          row8, row9, row10, row11, row12, row13, row14, row15);
454*b2055c35SXin Li   TRANSPOSE16x8_UB_UB(row0, row1, row2, row3, row4, row5, row6, row7,
455*b2055c35SXin Li                       row8, row9, row10, row11, row12, row13, row14, row15,
456*b2055c35SXin Li                       p3, p2, p1, p0, q0, q1, q2, q3);
457*b2055c35SXin Li   LPF_MASK_HEV(p3, p2, p1, p0, q0, q1, q2, q3, limit0, b_limit0, thresh0,
458*b2055c35SXin Li                hev, mask);
459*b2055c35SXin Li   LPF_FILTER4_4W(p1, p0, q0, q1, mask, hev);
460*b2055c35SXin Li   ILVR_B2_SH(p0, p1, q1, q0, tmp0, tmp1);
461*b2055c35SXin Li   ILVRL_H2_SH(tmp1, tmp0, tmp2, tmp3);
462*b2055c35SXin Li   ILVL_B2_SH(p0, p1, q1, q0, tmp0, tmp1);
463*b2055c35SXin Li   ILVRL_H2_SH(tmp1, tmp0, tmp4, tmp5);
464*b2055c35SXin Li   src -= 2;
465*b2055c35SXin Li   ST4x8_UB(tmp2, tmp3, src, stride);
466*b2055c35SXin Li   src += (8 * stride);
467*b2055c35SXin Li   ST4x8_UB(tmp4, tmp5, src, stride);
468*b2055c35SXin Li }
469*b2055c35SXin Li 
HFilter16i(uint8_t * src_y,int stride,int b_limit,int limit,int thresh)470*b2055c35SXin Li static void HFilter16i(uint8_t* src_y, int stride,
471*b2055c35SXin Li                        int b_limit, int limit, int thresh) {
472*b2055c35SXin Li   HFilterVertEdge16i(src_y +  4, stride, b_limit, limit, thresh);
473*b2055c35SXin Li   HFilterVertEdge16i(src_y +  8, stride, b_limit, limit, thresh);
474*b2055c35SXin Li   HFilterVertEdge16i(src_y + 12, stride, b_limit, limit, thresh);
475*b2055c35SXin Li }
476*b2055c35SXin Li 
477*b2055c35SXin Li // 8-pixels wide variants, for chroma filtering
VFilter8(uint8_t * src_u,uint8_t * src_v,int stride,int b_limit_in,int limit_in,int thresh_in)478*b2055c35SXin Li static void VFilter8(uint8_t* src_u, uint8_t* src_v, int stride,
479*b2055c35SXin Li                      int b_limit_in, int limit_in, int thresh_in) {
480*b2055c35SXin Li   uint8_t* ptmp_src_u = src_u - 4 * stride;
481*b2055c35SXin Li   uint8_t* ptmp_src_v = src_v - 4 * stride;
482*b2055c35SXin Li   uint64_t p2_d, p1_d, p0_d, q0_d, q1_d, q2_d;
483*b2055c35SXin Li   v16u8 p3, p2, p1, p0, q3, q2, q1, q0, mask, hev;
484*b2055c35SXin Li   v16u8 p3_u, p2_u, p1_u, p0_u, q3_u, q2_u, q1_u, q0_u;
485*b2055c35SXin Li   v16u8 p3_v, p2_v, p1_v, p0_v, q3_v, q2_v, q1_v, q0_v;
486*b2055c35SXin Li   const v16u8 b_limit = (v16u8)__msa_fill_b(b_limit_in);
487*b2055c35SXin Li   const v16u8 limit = (v16u8)__msa_fill_b(limit_in);
488*b2055c35SXin Li   const v16u8 thresh = (v16u8)__msa_fill_b(thresh_in);
489*b2055c35SXin Li 
490*b2055c35SXin Li   LD_UB8(ptmp_src_u, stride, p3_u, p2_u, p1_u, p0_u, q0_u, q1_u, q2_u, q3_u);
491*b2055c35SXin Li   LD_UB8(ptmp_src_v, stride, p3_v, p2_v, p1_v, p0_v, q0_v, q1_v, q2_v, q3_v);
492*b2055c35SXin Li   ILVR_D4_UB(p3_v, p3_u, p2_v, p2_u, p1_v, p1_u, p0_v, p0_u, p3, p2, p1, p0);
493*b2055c35SXin Li   ILVR_D4_UB(q0_v, q0_u, q1_v, q1_u, q2_v, q2_u, q3_v, q3_u, q0, q1, q2, q3);
494*b2055c35SXin Li   LPF_MASK_HEV(p3, p2, p1, p0, q0, q1, q2, q3, limit, b_limit, thresh,
495*b2055c35SXin Li                hev, mask);
496*b2055c35SXin Li   LPF_MBFILTER(p2, p1, p0, q0, q1, q2, mask, hev);
497*b2055c35SXin Li   p2_d = __msa_copy_s_d((v2i64)p2, 0);
498*b2055c35SXin Li   p1_d = __msa_copy_s_d((v2i64)p1, 0);
499*b2055c35SXin Li   p0_d = __msa_copy_s_d((v2i64)p0, 0);
500*b2055c35SXin Li   q0_d = __msa_copy_s_d((v2i64)q0, 0);
501*b2055c35SXin Li   q1_d = __msa_copy_s_d((v2i64)q1, 0);
502*b2055c35SXin Li   q2_d = __msa_copy_s_d((v2i64)q2, 0);
503*b2055c35SXin Li   ptmp_src_u += stride;
504*b2055c35SXin Li   SD4(p2_d, p1_d, p0_d, q0_d, ptmp_src_u, stride);
505*b2055c35SXin Li   ptmp_src_u += (4 * stride);
506*b2055c35SXin Li   SD(q1_d, ptmp_src_u);
507*b2055c35SXin Li   ptmp_src_u += stride;
508*b2055c35SXin Li   SD(q2_d, ptmp_src_u);
509*b2055c35SXin Li   p2_d = __msa_copy_s_d((v2i64)p2, 1);
510*b2055c35SXin Li   p1_d = __msa_copy_s_d((v2i64)p1, 1);
511*b2055c35SXin Li   p0_d = __msa_copy_s_d((v2i64)p0, 1);
512*b2055c35SXin Li   q0_d = __msa_copy_s_d((v2i64)q0, 1);
513*b2055c35SXin Li   q1_d = __msa_copy_s_d((v2i64)q1, 1);
514*b2055c35SXin Li   q2_d = __msa_copy_s_d((v2i64)q2, 1);
515*b2055c35SXin Li   ptmp_src_v += stride;
516*b2055c35SXin Li   SD4(p2_d, p1_d, p0_d, q0_d, ptmp_src_v, stride);
517*b2055c35SXin Li   ptmp_src_v += (4 * stride);
518*b2055c35SXin Li   SD(q1_d, ptmp_src_v);
519*b2055c35SXin Li   ptmp_src_v += stride;
520*b2055c35SXin Li   SD(q2_d, ptmp_src_v);
521*b2055c35SXin Li }
522*b2055c35SXin Li 
HFilter8(uint8_t * src_u,uint8_t * src_v,int stride,int b_limit_in,int limit_in,int thresh_in)523*b2055c35SXin Li static void HFilter8(uint8_t* src_u, uint8_t* src_v, int stride,
524*b2055c35SXin Li                      int b_limit_in, int limit_in, int thresh_in) {
525*b2055c35SXin Li   uint8_t* ptmp_src_u = src_u - 4;
526*b2055c35SXin Li   uint8_t* ptmp_src_v = src_v - 4;
527*b2055c35SXin Li   v16u8 p3, p2, p1, p0, q3, q2, q1, q0, mask, hev;
528*b2055c35SXin Li   v16u8 row0, row1, row2, row3, row4, row5, row6, row7, row8;
529*b2055c35SXin Li   v16u8 row9, row10, row11, row12, row13, row14, row15;
530*b2055c35SXin Li   v8i16 tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7;
531*b2055c35SXin Li   const v16u8 b_limit = (v16u8)__msa_fill_b(b_limit_in);
532*b2055c35SXin Li   const v16u8 limit = (v16u8)__msa_fill_b(limit_in);
533*b2055c35SXin Li   const v16u8 thresh = (v16u8)__msa_fill_b(thresh_in);
534*b2055c35SXin Li 
535*b2055c35SXin Li   LD_UB8(ptmp_src_u, stride, row0, row1, row2, row3, row4, row5, row6, row7);
536*b2055c35SXin Li   LD_UB8(ptmp_src_v, stride,
537*b2055c35SXin Li          row8, row9, row10, row11, row12, row13, row14, row15);
538*b2055c35SXin Li   TRANSPOSE16x8_UB_UB(row0, row1, row2, row3, row4, row5, row6, row7,
539*b2055c35SXin Li                       row8, row9, row10, row11, row12, row13, row14, row15,
540*b2055c35SXin Li                       p3, p2, p1, p0, q0, q1, q2, q3);
541*b2055c35SXin Li   LPF_MASK_HEV(p3, p2, p1, p0, q0, q1, q2, q3, limit, b_limit, thresh,
542*b2055c35SXin Li                hev, mask);
543*b2055c35SXin Li   LPF_MBFILTER(p2, p1, p0, q0, q1, q2, mask, hev);
544*b2055c35SXin Li   ILVR_B2_SH(p1, p2, q0, p0, tmp0, tmp1);
545*b2055c35SXin Li   ILVRL_H2_SH(tmp1, tmp0, tmp3, tmp4);
546*b2055c35SXin Li   ILVL_B2_SH(p1, p2, q0, p0, tmp0, tmp1);
547*b2055c35SXin Li   ILVRL_H2_SH(tmp1, tmp0, tmp6, tmp7);
548*b2055c35SXin Li   ILVRL_B2_SH(q2, q1, tmp2, tmp5);
549*b2055c35SXin Li   ptmp_src_u += 1;
550*b2055c35SXin Li   ST6x4_UB(tmp3, 0, tmp2, 0, ptmp_src_u, stride);
551*b2055c35SXin Li   ptmp_src_u += 4 * stride;
552*b2055c35SXin Li   ST6x4_UB(tmp4, 0, tmp2, 4, ptmp_src_u, stride);
553*b2055c35SXin Li   ptmp_src_v += 1;
554*b2055c35SXin Li   ST6x4_UB(tmp6, 0, tmp5, 0, ptmp_src_v, stride);
555*b2055c35SXin Li   ptmp_src_v += 4 * stride;
556*b2055c35SXin Li   ST6x4_UB(tmp7, 0, tmp5, 4, ptmp_src_v, stride);
557*b2055c35SXin Li }
558*b2055c35SXin Li 
VFilter8i(uint8_t * src_u,uint8_t * src_v,int stride,int b_limit_in,int limit_in,int thresh_in)559*b2055c35SXin Li static void VFilter8i(uint8_t* src_u, uint8_t* src_v, int stride,
560*b2055c35SXin Li                       int b_limit_in, int limit_in, int thresh_in) {
561*b2055c35SXin Li   uint64_t p1_d, p0_d, q0_d, q1_d;
562*b2055c35SXin Li   v16u8 p3, p2, p1, p0, q3, q2, q1, q0, mask, hev;
563*b2055c35SXin Li   v16u8 p3_u, p2_u, p1_u, p0_u, q3_u, q2_u, q1_u, q0_u;
564*b2055c35SXin Li   v16u8 p3_v, p2_v, p1_v, p0_v, q3_v, q2_v, q1_v, q0_v;
565*b2055c35SXin Li   const v16u8 thresh = (v16u8)__msa_fill_b(thresh_in);
566*b2055c35SXin Li   const v16u8 limit = (v16u8)__msa_fill_b(limit_in);
567*b2055c35SXin Li   const v16u8 b_limit = (v16u8)__msa_fill_b(b_limit_in);
568*b2055c35SXin Li 
569*b2055c35SXin Li   LD_UB8(src_u, stride, p3_u, p2_u, p1_u, p0_u, q0_u, q1_u, q2_u, q3_u);
570*b2055c35SXin Li   src_u += (5 * stride);
571*b2055c35SXin Li   LD_UB8(src_v, stride, p3_v, p2_v, p1_v, p0_v, q0_v, q1_v, q2_v, q3_v);
572*b2055c35SXin Li   src_v += (5 * stride);
573*b2055c35SXin Li   ILVR_D4_UB(p3_v, p3_u, p2_v, p2_u, p1_v, p1_u, p0_v, p0_u, p3, p2, p1, p0);
574*b2055c35SXin Li   ILVR_D4_UB(q0_v, q0_u, q1_v, q1_u, q2_v, q2_u, q3_v, q3_u, q0, q1, q2, q3);
575*b2055c35SXin Li   LPF_MASK_HEV(p3, p2, p1, p0, q0, q1, q2, q3, limit, b_limit, thresh,
576*b2055c35SXin Li                hev, mask);
577*b2055c35SXin Li   LPF_FILTER4_4W(p1, p0, q0, q1, mask, hev);
578*b2055c35SXin Li   p1_d = __msa_copy_s_d((v2i64)p1, 0);
579*b2055c35SXin Li   p0_d = __msa_copy_s_d((v2i64)p0, 0);
580*b2055c35SXin Li   q0_d = __msa_copy_s_d((v2i64)q0, 0);
581*b2055c35SXin Li   q1_d = __msa_copy_s_d((v2i64)q1, 0);
582*b2055c35SXin Li   SD4(q1_d, q0_d, p0_d, p1_d, src_u, -stride);
583*b2055c35SXin Li   p1_d = __msa_copy_s_d((v2i64)p1, 1);
584*b2055c35SXin Li   p0_d = __msa_copy_s_d((v2i64)p0, 1);
585*b2055c35SXin Li   q0_d = __msa_copy_s_d((v2i64)q0, 1);
586*b2055c35SXin Li   q1_d = __msa_copy_s_d((v2i64)q1, 1);
587*b2055c35SXin Li   SD4(q1_d, q0_d, p0_d, p1_d, src_v, -stride);
588*b2055c35SXin Li }
589*b2055c35SXin Li 
HFilter8i(uint8_t * src_u,uint8_t * src_v,int stride,int b_limit_in,int limit_in,int thresh_in)590*b2055c35SXin Li static void HFilter8i(uint8_t* src_u, uint8_t* src_v, int stride,
591*b2055c35SXin Li                       int b_limit_in, int limit_in, int thresh_in) {
592*b2055c35SXin Li   v16u8 p3, p2, p1, p0, q3, q2, q1, q0, mask, hev;
593*b2055c35SXin Li   v16u8 row0, row1, row2, row3, row4, row5, row6, row7, row8;
594*b2055c35SXin Li   v16u8 row9, row10, row11, row12, row13, row14, row15;
595*b2055c35SXin Li   v4i32 tmp0, tmp1, tmp2, tmp3, tmp4, tmp5;
596*b2055c35SXin Li   const v16u8 thresh = (v16u8)__msa_fill_b(thresh_in);
597*b2055c35SXin Li   const v16u8 limit = (v16u8)__msa_fill_b(limit_in);
598*b2055c35SXin Li   const v16u8 b_limit = (v16u8)__msa_fill_b(b_limit_in);
599*b2055c35SXin Li 
600*b2055c35SXin Li   LD_UB8(src_u, stride, row0, row1, row2, row3, row4, row5, row6, row7);
601*b2055c35SXin Li   LD_UB8(src_v, stride,
602*b2055c35SXin Li          row8, row9, row10, row11, row12, row13, row14, row15);
603*b2055c35SXin Li   TRANSPOSE16x8_UB_UB(row0, row1, row2, row3, row4, row5, row6, row7,
604*b2055c35SXin Li                       row8, row9, row10, row11, row12, row13, row14, row15,
605*b2055c35SXin Li                       p3, p2, p1, p0, q0, q1, q2, q3);
606*b2055c35SXin Li   LPF_MASK_HEV(p3, p2, p1, p0, q0, q1, q2, q3, limit, b_limit, thresh,
607*b2055c35SXin Li                hev, mask);
608*b2055c35SXin Li   LPF_FILTER4_4W(p1, p0, q0, q1, mask, hev);
609*b2055c35SXin Li   ILVR_B2_SW(p0, p1, q1, q0, tmp0, tmp1);
610*b2055c35SXin Li   ILVRL_H2_SW(tmp1, tmp0, tmp2, tmp3);
611*b2055c35SXin Li   ILVL_B2_SW(p0, p1, q1, q0, tmp0, tmp1);
612*b2055c35SXin Li   ILVRL_H2_SW(tmp1, tmp0, tmp4, tmp5);
613*b2055c35SXin Li   src_u += 2;
614*b2055c35SXin Li   ST4x4_UB(tmp2, tmp2, 0, 1, 2, 3, src_u, stride);
615*b2055c35SXin Li   src_u += 4 * stride;
616*b2055c35SXin Li   ST4x4_UB(tmp3, tmp3, 0, 1, 2, 3, src_u, stride);
617*b2055c35SXin Li   src_v += 2;
618*b2055c35SXin Li   ST4x4_UB(tmp4, tmp4, 0, 1, 2, 3, src_v, stride);
619*b2055c35SXin Li   src_v += 4 * stride;
620*b2055c35SXin Li   ST4x4_UB(tmp5, tmp5, 0, 1, 2, 3, src_v, stride);
621*b2055c35SXin Li }
622*b2055c35SXin Li 
SimpleVFilter16(uint8_t * src,int stride,int b_limit_in)623*b2055c35SXin Li static void SimpleVFilter16(uint8_t* src, int stride, int b_limit_in) {
624*b2055c35SXin Li   v16u8 p1, p0, q1, q0, mask;
625*b2055c35SXin Li   const v16u8 b_limit = (v16u8)__msa_fill_b(b_limit_in);
626*b2055c35SXin Li 
627*b2055c35SXin Li   LD_UB4(src - 2 * stride, stride, p1, p0, q0, q1);
628*b2055c35SXin Li   LPF_SIMPLE_MASK(p1, p0, q0, q1, b_limit, mask);
629*b2055c35SXin Li   LPF_SIMPLE_FILT(p1, p0, q0, q1, mask);
630*b2055c35SXin Li   ST_UB2(p0, q0, src - stride, stride);
631*b2055c35SXin Li }
632*b2055c35SXin Li 
SimpleHFilter16(uint8_t * src,int stride,int b_limit_in)633*b2055c35SXin Li static void SimpleHFilter16(uint8_t* src, int stride, int b_limit_in) {
634*b2055c35SXin Li   v16u8 p1, p0, q1, q0, mask, row0, row1, row2, row3, row4, row5, row6, row7;
635*b2055c35SXin Li   v16u8 row8, row9, row10, row11, row12, row13, row14, row15;
636*b2055c35SXin Li   v8i16 tmp0, tmp1;
637*b2055c35SXin Li   const v16u8 b_limit = (v16u8)__msa_fill_b(b_limit_in);
638*b2055c35SXin Li   uint8_t* ptemp_src = src - 2;
639*b2055c35SXin Li 
640*b2055c35SXin Li   LD_UB8(ptemp_src, stride, row0, row1, row2, row3, row4, row5, row6, row7);
641*b2055c35SXin Li   LD_UB8(ptemp_src + 8 * stride, stride,
642*b2055c35SXin Li          row8, row9, row10, row11, row12, row13, row14, row15);
643*b2055c35SXin Li   TRANSPOSE16x4_UB_UB(row0, row1, row2, row3, row4, row5, row6, row7,
644*b2055c35SXin Li                       row8, row9, row10, row11, row12, row13, row14, row15,
645*b2055c35SXin Li                       p1, p0, q0, q1);
646*b2055c35SXin Li   LPF_SIMPLE_MASK(p1, p0, q0, q1, b_limit, mask);
647*b2055c35SXin Li   LPF_SIMPLE_FILT(p1, p0, q0, q1, mask);
648*b2055c35SXin Li   ILVRL_B2_SH(q0, p0, tmp1, tmp0);
649*b2055c35SXin Li   ptemp_src += 1;
650*b2055c35SXin Li   ST2x4_UB(tmp1, 0, ptemp_src, stride);
651*b2055c35SXin Li   ptemp_src += 4 * stride;
652*b2055c35SXin Li   ST2x4_UB(tmp1, 4, ptemp_src, stride);
653*b2055c35SXin Li   ptemp_src += 4 * stride;
654*b2055c35SXin Li   ST2x4_UB(tmp0, 0, ptemp_src, stride);
655*b2055c35SXin Li   ptemp_src += 4 * stride;
656*b2055c35SXin Li   ST2x4_UB(tmp0, 4, ptemp_src, stride);
657*b2055c35SXin Li   ptemp_src += 4 * stride;
658*b2055c35SXin Li }
659*b2055c35SXin Li 
SimpleVFilter16i(uint8_t * src_y,int stride,int b_limit_in)660*b2055c35SXin Li static void SimpleVFilter16i(uint8_t* src_y, int stride, int b_limit_in) {
661*b2055c35SXin Li   SimpleVFilter16(src_y +  4 * stride, stride, b_limit_in);
662*b2055c35SXin Li   SimpleVFilter16(src_y +  8 * stride, stride, b_limit_in);
663*b2055c35SXin Li   SimpleVFilter16(src_y + 12 * stride, stride, b_limit_in);
664*b2055c35SXin Li }
665*b2055c35SXin Li 
SimpleHFilter16i(uint8_t * src_y,int stride,int b_limit_in)666*b2055c35SXin Li static void SimpleHFilter16i(uint8_t* src_y, int stride, int b_limit_in) {
667*b2055c35SXin Li   SimpleHFilter16(src_y +  4, stride, b_limit_in);
668*b2055c35SXin Li   SimpleHFilter16(src_y +  8, stride, b_limit_in);
669*b2055c35SXin Li   SimpleHFilter16(src_y + 12, stride, b_limit_in);
670*b2055c35SXin Li }
671*b2055c35SXin Li 
672*b2055c35SXin Li //------------------------------------------------------------------------------
673*b2055c35SXin Li // Intra predictions
674*b2055c35SXin Li //------------------------------------------------------------------------------
675*b2055c35SXin Li 
676*b2055c35SXin Li // 4x4
677*b2055c35SXin Li 
DC4(uint8_t * dst)678*b2055c35SXin Li static void DC4(uint8_t* dst) {   // DC
679*b2055c35SXin Li   uint32_t dc = 4;
680*b2055c35SXin Li   int i;
681*b2055c35SXin Li   for (i = 0; i < 4; ++i) dc += dst[i - BPS] + dst[-1 + i * BPS];
682*b2055c35SXin Li   dc >>= 3;
683*b2055c35SXin Li   dc = dc | (dc << 8) | (dc << 16) | (dc << 24);
684*b2055c35SXin Li   SW4(dc, dc, dc, dc, dst, BPS);
685*b2055c35SXin Li }
686*b2055c35SXin Li 
TM4(uint8_t * dst)687*b2055c35SXin Li static void TM4(uint8_t* dst) {
688*b2055c35SXin Li   const uint8_t* const ptemp = dst - BPS - 1;
689*b2055c35SXin Li   v8i16 T, d, r0, r1, r2, r3;
690*b2055c35SXin Li   const v16i8 zero = { 0 };
691*b2055c35SXin Li   const v8i16 TL = (v8i16)__msa_fill_h(ptemp[0 * BPS]);
692*b2055c35SXin Li   const v8i16 L0 = (v8i16)__msa_fill_h(ptemp[1 * BPS]);
693*b2055c35SXin Li   const v8i16 L1 = (v8i16)__msa_fill_h(ptemp[2 * BPS]);
694*b2055c35SXin Li   const v8i16 L2 = (v8i16)__msa_fill_h(ptemp[3 * BPS]);
695*b2055c35SXin Li   const v8i16 L3 = (v8i16)__msa_fill_h(ptemp[4 * BPS]);
696*b2055c35SXin Li   const v16u8 T1 = LD_UB(ptemp + 1);
697*b2055c35SXin Li 
698*b2055c35SXin Li   T  = (v8i16)__msa_ilvr_b(zero, (v16i8)T1);
699*b2055c35SXin Li   d = T - TL;
700*b2055c35SXin Li   ADD4(d, L0, d, L1, d, L2, d, L3, r0, r1, r2, r3);
701*b2055c35SXin Li   CLIP_SH4_0_255(r0, r1, r2, r3);
702*b2055c35SXin Li   PCKEV_ST4x4_UB(r0, r1, r2, r3, dst, BPS);
703*b2055c35SXin Li }
704*b2055c35SXin Li 
VE4(uint8_t * dst)705*b2055c35SXin Li static void VE4(uint8_t* dst) {    // vertical
706*b2055c35SXin Li   const uint8_t* const ptop = dst - BPS - 1;
707*b2055c35SXin Li   const uint32_t val0 = LW(ptop + 0);
708*b2055c35SXin Li   const uint32_t val1 = LW(ptop + 4);
709*b2055c35SXin Li   uint32_t out;
710*b2055c35SXin Li   v16u8 A = { 0 }, B, C, AC, B2, R;
711*b2055c35SXin Li 
712*b2055c35SXin Li   INSERT_W2_UB(val0, val1, A);
713*b2055c35SXin Li   B = SLDI_UB(A, A, 1);
714*b2055c35SXin Li   C = SLDI_UB(A, A, 2);
715*b2055c35SXin Li   AC = __msa_ave_u_b(A, C);
716*b2055c35SXin Li   B2 = __msa_ave_u_b(B, B);
717*b2055c35SXin Li   R = __msa_aver_u_b(AC, B2);
718*b2055c35SXin Li   out = __msa_copy_s_w((v4i32)R, 0);
719*b2055c35SXin Li   SW4(out, out, out, out, dst, BPS);
720*b2055c35SXin Li }
721*b2055c35SXin Li 
RD4(uint8_t * dst)722*b2055c35SXin Li static void RD4(uint8_t* dst) {   // Down-right
723*b2055c35SXin Li   const uint8_t* const ptop = dst - 1 - BPS;
724*b2055c35SXin Li   uint32_t val0 = LW(ptop + 0);
725*b2055c35SXin Li   uint32_t val1 = LW(ptop + 4);
726*b2055c35SXin Li   uint32_t val2, val3;
727*b2055c35SXin Li   v16u8 A, B, C, AC, B2, R, A1 = { 0 };
728*b2055c35SXin Li 
729*b2055c35SXin Li   INSERT_W2_UB(val0, val1, A1);
730*b2055c35SXin Li   A = SLDI_UB(A1, A1, 12);
731*b2055c35SXin Li   A = (v16u8)__msa_insert_b((v16i8)A, 3, ptop[1 * BPS]);
732*b2055c35SXin Li   A = (v16u8)__msa_insert_b((v16i8)A, 2, ptop[2 * BPS]);
733*b2055c35SXin Li   A = (v16u8)__msa_insert_b((v16i8)A, 1, ptop[3 * BPS]);
734*b2055c35SXin Li   A = (v16u8)__msa_insert_b((v16i8)A, 0, ptop[4 * BPS]);
735*b2055c35SXin Li   B = SLDI_UB(A, A, 1);
736*b2055c35SXin Li   C = SLDI_UB(A, A, 2);
737*b2055c35SXin Li   AC = __msa_ave_u_b(A, C);
738*b2055c35SXin Li   B2 = __msa_ave_u_b(B, B);
739*b2055c35SXin Li   R = __msa_aver_u_b(AC, B2);
740*b2055c35SXin Li   val3 = __msa_copy_s_w((v4i32)R, 0);
741*b2055c35SXin Li   R = SLDI_UB(R, R, 1);
742*b2055c35SXin Li   val2 = __msa_copy_s_w((v4i32)R, 0);
743*b2055c35SXin Li   R = SLDI_UB(R, R, 1);
744*b2055c35SXin Li   val1 = __msa_copy_s_w((v4i32)R, 0);
745*b2055c35SXin Li   R = SLDI_UB(R, R, 1);
746*b2055c35SXin Li   val0 = __msa_copy_s_w((v4i32)R, 0);
747*b2055c35SXin Li   SW4(val0, val1, val2, val3, dst, BPS);
748*b2055c35SXin Li }
749*b2055c35SXin Li 
LD4(uint8_t * dst)750*b2055c35SXin Li static void LD4(uint8_t* dst) {   // Down-Left
751*b2055c35SXin Li   const uint8_t* const ptop = dst - BPS;
752*b2055c35SXin Li   uint32_t val0 = LW(ptop + 0);
753*b2055c35SXin Li   uint32_t val1 = LW(ptop + 4);
754*b2055c35SXin Li   uint32_t val2, val3;
755*b2055c35SXin Li   v16u8 A = { 0 }, B, C, AC, B2, R;
756*b2055c35SXin Li 
757*b2055c35SXin Li   INSERT_W2_UB(val0, val1, A);
758*b2055c35SXin Li   B = SLDI_UB(A, A, 1);
759*b2055c35SXin Li   C = SLDI_UB(A, A, 2);
760*b2055c35SXin Li   C = (v16u8)__msa_insert_b((v16i8)C, 6, ptop[7]);
761*b2055c35SXin Li   AC = __msa_ave_u_b(A, C);
762*b2055c35SXin Li   B2 = __msa_ave_u_b(B, B);
763*b2055c35SXin Li   R = __msa_aver_u_b(AC, B2);
764*b2055c35SXin Li   val0 = __msa_copy_s_w((v4i32)R, 0);
765*b2055c35SXin Li   R = SLDI_UB(R, R, 1);
766*b2055c35SXin Li   val1 = __msa_copy_s_w((v4i32)R, 0);
767*b2055c35SXin Li   R = SLDI_UB(R, R, 1);
768*b2055c35SXin Li   val2 = __msa_copy_s_w((v4i32)R, 0);
769*b2055c35SXin Li   R = SLDI_UB(R, R, 1);
770*b2055c35SXin Li   val3 = __msa_copy_s_w((v4i32)R, 0);
771*b2055c35SXin Li   SW4(val0, val1, val2, val3, dst, BPS);
772*b2055c35SXin Li }
773*b2055c35SXin Li 
774*b2055c35SXin Li // 16x16
775*b2055c35SXin Li 
DC16(uint8_t * dst)776*b2055c35SXin Li static void DC16(uint8_t* dst) {   // DC
777*b2055c35SXin Li   uint32_t dc = 16;
778*b2055c35SXin Li   int i;
779*b2055c35SXin Li   const v16u8 rtop = LD_UB(dst - BPS);
780*b2055c35SXin Li   const v8u16 dctop = __msa_hadd_u_h(rtop, rtop);
781*b2055c35SXin Li   v16u8 out;
782*b2055c35SXin Li 
783*b2055c35SXin Li   for (i = 0; i < 16; ++i) {
784*b2055c35SXin Li     dc += dst[-1 + i * BPS];
785*b2055c35SXin Li   }
786*b2055c35SXin Li   dc += HADD_UH_U32(dctop);
787*b2055c35SXin Li   out = (v16u8)__msa_fill_b(dc >> 5);
788*b2055c35SXin Li   ST_UB8(out, out, out, out, out, out, out, out, dst, BPS);
789*b2055c35SXin Li   ST_UB8(out, out, out, out, out, out, out, out, dst + 8 * BPS, BPS);
790*b2055c35SXin Li }
791*b2055c35SXin Li 
TM16(uint8_t * dst)792*b2055c35SXin Li static void TM16(uint8_t* dst) {
793*b2055c35SXin Li   int j;
794*b2055c35SXin Li   v8i16 d1, d2;
795*b2055c35SXin Li   const v16i8 zero = { 0 };
796*b2055c35SXin Li   const v8i16 TL = (v8i16)__msa_fill_h(dst[-1 - BPS]);
797*b2055c35SXin Li   const v16i8 T = LD_SB(dst - BPS);
798*b2055c35SXin Li 
799*b2055c35SXin Li   ILVRL_B2_SH(zero, T, d1, d2);
800*b2055c35SXin Li   SUB2(d1, TL, d2, TL, d1, d2);
801*b2055c35SXin Li   for (j = 0; j < 16; j += 4) {
802*b2055c35SXin Li     v16i8 t0, t1, t2, t3;
803*b2055c35SXin Li     v8i16 r0, r1, r2, r3, r4, r5, r6, r7;
804*b2055c35SXin Li     const v8i16 L0 = (v8i16)__msa_fill_h(dst[-1 + 0 * BPS]);
805*b2055c35SXin Li     const v8i16 L1 = (v8i16)__msa_fill_h(dst[-1 + 1 * BPS]);
806*b2055c35SXin Li     const v8i16 L2 = (v8i16)__msa_fill_h(dst[-1 + 2 * BPS]);
807*b2055c35SXin Li     const v8i16 L3 = (v8i16)__msa_fill_h(dst[-1 + 3 * BPS]);
808*b2055c35SXin Li     ADD4(d1, L0, d1, L1, d1, L2, d1, L3, r0, r1, r2, r3);
809*b2055c35SXin Li     ADD4(d2, L0, d2, L1, d2, L2, d2, L3, r4, r5, r6, r7);
810*b2055c35SXin Li     CLIP_SH4_0_255(r0, r1, r2, r3);
811*b2055c35SXin Li     CLIP_SH4_0_255(r4, r5, r6, r7);
812*b2055c35SXin Li     PCKEV_B4_SB(r4, r0, r5, r1, r6, r2, r7, r3, t0, t1, t2, t3);
813*b2055c35SXin Li     ST_SB4(t0, t1, t2, t3, dst, BPS);
814*b2055c35SXin Li     dst += 4 * BPS;
815*b2055c35SXin Li   }
816*b2055c35SXin Li }
817*b2055c35SXin Li 
VE16(uint8_t * dst)818*b2055c35SXin Li static void VE16(uint8_t* dst) {   // vertical
819*b2055c35SXin Li   const v16u8 rtop = LD_UB(dst - BPS);
820*b2055c35SXin Li   ST_UB8(rtop, rtop, rtop, rtop, rtop, rtop, rtop, rtop, dst, BPS);
821*b2055c35SXin Li   ST_UB8(rtop, rtop, rtop, rtop, rtop, rtop, rtop, rtop, dst + 8 * BPS, BPS);
822*b2055c35SXin Li }
823*b2055c35SXin Li 
HE16(uint8_t * dst)824*b2055c35SXin Li static void HE16(uint8_t* dst) {   // horizontal
825*b2055c35SXin Li   int j;
826*b2055c35SXin Li   for (j = 16; j > 0; j -= 4) {
827*b2055c35SXin Li     const v16u8 L0 = (v16u8)__msa_fill_b(dst[-1 + 0 * BPS]);
828*b2055c35SXin Li     const v16u8 L1 = (v16u8)__msa_fill_b(dst[-1 + 1 * BPS]);
829*b2055c35SXin Li     const v16u8 L2 = (v16u8)__msa_fill_b(dst[-1 + 2 * BPS]);
830*b2055c35SXin Li     const v16u8 L3 = (v16u8)__msa_fill_b(dst[-1 + 3 * BPS]);
831*b2055c35SXin Li     ST_UB4(L0, L1, L2, L3, dst, BPS);
832*b2055c35SXin Li     dst += 4 * BPS;
833*b2055c35SXin Li   }
834*b2055c35SXin Li }
835*b2055c35SXin Li 
DC16NoTop(uint8_t * dst)836*b2055c35SXin Li static void DC16NoTop(uint8_t* dst) {   // DC with top samples not available
837*b2055c35SXin Li   int j;
838*b2055c35SXin Li   uint32_t dc = 8;
839*b2055c35SXin Li   v16u8 out;
840*b2055c35SXin Li 
841*b2055c35SXin Li   for (j = 0; j < 16; ++j) {
842*b2055c35SXin Li     dc += dst[-1 + j * BPS];
843*b2055c35SXin Li   }
844*b2055c35SXin Li   out = (v16u8)__msa_fill_b(dc >> 4);
845*b2055c35SXin Li   ST_UB8(out, out, out, out, out, out, out, out, dst, BPS);
846*b2055c35SXin Li   ST_UB8(out, out, out, out, out, out, out, out, dst + 8 * BPS, BPS);
847*b2055c35SXin Li }
848*b2055c35SXin Li 
DC16NoLeft(uint8_t * dst)849*b2055c35SXin Li static void DC16NoLeft(uint8_t* dst) {   // DC with left samples not available
850*b2055c35SXin Li   uint32_t dc = 8;
851*b2055c35SXin Li   const v16u8 rtop = LD_UB(dst - BPS);
852*b2055c35SXin Li   const v8u16 dctop = __msa_hadd_u_h(rtop, rtop);
853*b2055c35SXin Li   v16u8 out;
854*b2055c35SXin Li 
855*b2055c35SXin Li   dc += HADD_UH_U32(dctop);
856*b2055c35SXin Li   out = (v16u8)__msa_fill_b(dc >> 4);
857*b2055c35SXin Li   ST_UB8(out, out, out, out, out, out, out, out, dst, BPS);
858*b2055c35SXin Li   ST_UB8(out, out, out, out, out, out, out, out, dst + 8 * BPS, BPS);
859*b2055c35SXin Li }
860*b2055c35SXin Li 
DC16NoTopLeft(uint8_t * dst)861*b2055c35SXin Li static void DC16NoTopLeft(uint8_t* dst) {   // DC with nothing
862*b2055c35SXin Li   const v16u8 out = (v16u8)__msa_fill_b(0x80);
863*b2055c35SXin Li   ST_UB8(out, out, out, out, out, out, out, out, dst, BPS);
864*b2055c35SXin Li   ST_UB8(out, out, out, out, out, out, out, out, dst + 8 * BPS, BPS);
865*b2055c35SXin Li }
866*b2055c35SXin Li 
867*b2055c35SXin Li // Chroma
868*b2055c35SXin Li 
869*b2055c35SXin Li #define STORE8x8(out, dst) do {                 \
870*b2055c35SXin Li   SD4(out, out, out, out, dst + 0 * BPS, BPS);  \
871*b2055c35SXin Li   SD4(out, out, out, out, dst + 4 * BPS, BPS);  \
872*b2055c35SXin Li } while (0)
873*b2055c35SXin Li 
DC8uv(uint8_t * dst)874*b2055c35SXin Li static void DC8uv(uint8_t* dst) {   // DC
875*b2055c35SXin Li   uint32_t dc = 8;
876*b2055c35SXin Li   int i;
877*b2055c35SXin Li   uint64_t out;
878*b2055c35SXin Li   const v16u8 rtop = LD_UB(dst - BPS);
879*b2055c35SXin Li   const v8u16 temp0 = __msa_hadd_u_h(rtop, rtop);
880*b2055c35SXin Li   const v4u32 temp1 = __msa_hadd_u_w(temp0, temp0);
881*b2055c35SXin Li   const v2u64 temp2 = __msa_hadd_u_d(temp1, temp1);
882*b2055c35SXin Li   v16u8 dctemp;
883*b2055c35SXin Li 
884*b2055c35SXin Li   for (i = 0; i < 8; ++i) {
885*b2055c35SXin Li     dc += dst[-1 + i * BPS];
886*b2055c35SXin Li   }
887*b2055c35SXin Li   dc += __msa_copy_s_w((v4i32)temp2, 0);
888*b2055c35SXin Li   dctemp = (v16u8)__msa_fill_b(dc >> 4);
889*b2055c35SXin Li   out = __msa_copy_s_d((v2i64)dctemp, 0);
890*b2055c35SXin Li   STORE8x8(out, dst);
891*b2055c35SXin Li }
892*b2055c35SXin Li 
TM8uv(uint8_t * dst)893*b2055c35SXin Li static void TM8uv(uint8_t* dst) {
894*b2055c35SXin Li   int j;
895*b2055c35SXin Li   const v16i8 T1 = LD_SB(dst - BPS);
896*b2055c35SXin Li   const v16i8 zero = { 0 };
897*b2055c35SXin Li   const v8i16 T  = (v8i16)__msa_ilvr_b(zero, T1);
898*b2055c35SXin Li   const v8i16 TL = (v8i16)__msa_fill_h(dst[-1 - BPS]);
899*b2055c35SXin Li   const v8i16 d = T - TL;
900*b2055c35SXin Li 
901*b2055c35SXin Li   for (j = 0; j < 8; j += 4) {
902*b2055c35SXin Li     v16i8 t0, t1;
903*b2055c35SXin Li     v8i16 r0 = (v8i16)__msa_fill_h(dst[-1 + 0 * BPS]);
904*b2055c35SXin Li     v8i16 r1 = (v8i16)__msa_fill_h(dst[-1 + 1 * BPS]);
905*b2055c35SXin Li     v8i16 r2 = (v8i16)__msa_fill_h(dst[-1 + 2 * BPS]);
906*b2055c35SXin Li     v8i16 r3 = (v8i16)__msa_fill_h(dst[-1 + 3 * BPS]);
907*b2055c35SXin Li     ADD4(d, r0, d, r1, d, r2, d, r3, r0, r1, r2, r3);
908*b2055c35SXin Li     CLIP_SH4_0_255(r0, r1, r2, r3);
909*b2055c35SXin Li     PCKEV_B2_SB(r1, r0, r3, r2, t0, t1);
910*b2055c35SXin Li     ST4x4_UB(t0, t1, 0, 2, 0, 2, dst, BPS);
911*b2055c35SXin Li     ST4x4_UB(t0, t1, 1, 3, 1, 3, dst + 4, BPS);
912*b2055c35SXin Li     dst += 4 * BPS;
913*b2055c35SXin Li   }
914*b2055c35SXin Li }
915*b2055c35SXin Li 
VE8uv(uint8_t * dst)916*b2055c35SXin Li static void VE8uv(uint8_t* dst) {   // vertical
917*b2055c35SXin Li   const v16u8 rtop = LD_UB(dst - BPS);
918*b2055c35SXin Li   const uint64_t out = __msa_copy_s_d((v2i64)rtop, 0);
919*b2055c35SXin Li   STORE8x8(out, dst);
920*b2055c35SXin Li }
921*b2055c35SXin Li 
HE8uv(uint8_t * dst)922*b2055c35SXin Li static void HE8uv(uint8_t* dst) {   // horizontal
923*b2055c35SXin Li   int j;
924*b2055c35SXin Li   for (j = 0; j < 8; j += 4) {
925*b2055c35SXin Li     const v16u8 L0 = (v16u8)__msa_fill_b(dst[-1 + 0 * BPS]);
926*b2055c35SXin Li     const v16u8 L1 = (v16u8)__msa_fill_b(dst[-1 + 1 * BPS]);
927*b2055c35SXin Li     const v16u8 L2 = (v16u8)__msa_fill_b(dst[-1 + 2 * BPS]);
928*b2055c35SXin Li     const v16u8 L3 = (v16u8)__msa_fill_b(dst[-1 + 3 * BPS]);
929*b2055c35SXin Li     const uint64_t out0 = __msa_copy_s_d((v2i64)L0, 0);
930*b2055c35SXin Li     const uint64_t out1 = __msa_copy_s_d((v2i64)L1, 0);
931*b2055c35SXin Li     const uint64_t out2 = __msa_copy_s_d((v2i64)L2, 0);
932*b2055c35SXin Li     const uint64_t out3 = __msa_copy_s_d((v2i64)L3, 0);
933*b2055c35SXin Li     SD4(out0, out1, out2, out3, dst, BPS);
934*b2055c35SXin Li     dst += 4 * BPS;
935*b2055c35SXin Li   }
936*b2055c35SXin Li }
937*b2055c35SXin Li 
DC8uvNoLeft(uint8_t * dst)938*b2055c35SXin Li static void DC8uvNoLeft(uint8_t* dst) {   // DC with no left samples
939*b2055c35SXin Li   const uint32_t dc = 4;
940*b2055c35SXin Li   const v16u8 rtop = LD_UB(dst - BPS);
941*b2055c35SXin Li   const v8u16 temp0 = __msa_hadd_u_h(rtop, rtop);
942*b2055c35SXin Li   const v4u32 temp1 = __msa_hadd_u_w(temp0, temp0);
943*b2055c35SXin Li   const v2u64 temp2 = __msa_hadd_u_d(temp1, temp1);
944*b2055c35SXin Li   const uint32_t sum_m = __msa_copy_s_w((v4i32)temp2, 0);
945*b2055c35SXin Li   const v16u8 dcval = (v16u8)__msa_fill_b((dc + sum_m) >> 3);
946*b2055c35SXin Li   const uint64_t out = __msa_copy_s_d((v2i64)dcval, 0);
947*b2055c35SXin Li   STORE8x8(out, dst);
948*b2055c35SXin Li }
949*b2055c35SXin Li 
DC8uvNoTop(uint8_t * dst)950*b2055c35SXin Li static void DC8uvNoTop(uint8_t* dst) {   // DC with no top samples
951*b2055c35SXin Li   uint32_t dc = 4;
952*b2055c35SXin Li   int i;
953*b2055c35SXin Li   uint64_t out;
954*b2055c35SXin Li   v16u8 dctemp;
955*b2055c35SXin Li 
956*b2055c35SXin Li   for (i = 0; i < 8; ++i) {
957*b2055c35SXin Li     dc += dst[-1 + i * BPS];
958*b2055c35SXin Li   }
959*b2055c35SXin Li   dctemp = (v16u8)__msa_fill_b(dc >> 3);
960*b2055c35SXin Li   out = __msa_copy_s_d((v2i64)dctemp, 0);
961*b2055c35SXin Li   STORE8x8(out, dst);
962*b2055c35SXin Li }
963*b2055c35SXin Li 
DC8uvNoTopLeft(uint8_t * dst)964*b2055c35SXin Li static void DC8uvNoTopLeft(uint8_t* dst) {   // DC with nothing
965*b2055c35SXin Li   const uint64_t out = 0x8080808080808080ULL;
966*b2055c35SXin Li   STORE8x8(out, dst);
967*b2055c35SXin Li }
968*b2055c35SXin Li 
969*b2055c35SXin Li //------------------------------------------------------------------------------
970*b2055c35SXin Li // Entry point
971*b2055c35SXin Li 
972*b2055c35SXin Li extern void VP8DspInitMSA(void);
973*b2055c35SXin Li 
VP8DspInitMSA(void)974*b2055c35SXin Li WEBP_TSAN_IGNORE_FUNCTION void VP8DspInitMSA(void) {
975*b2055c35SXin Li   VP8TransformWHT = TransformWHT;
976*b2055c35SXin Li   VP8Transform = TransformTwo;
977*b2055c35SXin Li   VP8TransformDC = TransformDC;
978*b2055c35SXin Li   VP8TransformAC3 = TransformAC3;
979*b2055c35SXin Li 
980*b2055c35SXin Li   VP8VFilter16  = VFilter16;
981*b2055c35SXin Li   VP8HFilter16  = HFilter16;
982*b2055c35SXin Li   VP8VFilter16i = VFilter16i;
983*b2055c35SXin Li   VP8HFilter16i = HFilter16i;
984*b2055c35SXin Li   VP8VFilter8  = VFilter8;
985*b2055c35SXin Li   VP8HFilter8  = HFilter8;
986*b2055c35SXin Li   VP8VFilter8i = VFilter8i;
987*b2055c35SXin Li   VP8HFilter8i = HFilter8i;
988*b2055c35SXin Li   VP8SimpleVFilter16  = SimpleVFilter16;
989*b2055c35SXin Li   VP8SimpleHFilter16  = SimpleHFilter16;
990*b2055c35SXin Li   VP8SimpleVFilter16i = SimpleVFilter16i;
991*b2055c35SXin Li   VP8SimpleHFilter16i = SimpleHFilter16i;
992*b2055c35SXin Li 
993*b2055c35SXin Li   VP8PredLuma4[0] = DC4;
994*b2055c35SXin Li   VP8PredLuma4[1] = TM4;
995*b2055c35SXin Li   VP8PredLuma4[2] = VE4;
996*b2055c35SXin Li   VP8PredLuma4[4] = RD4;
997*b2055c35SXin Li   VP8PredLuma4[6] = LD4;
998*b2055c35SXin Li   VP8PredLuma16[0] = DC16;
999*b2055c35SXin Li   VP8PredLuma16[1] = TM16;
1000*b2055c35SXin Li   VP8PredLuma16[2] = VE16;
1001*b2055c35SXin Li   VP8PredLuma16[3] = HE16;
1002*b2055c35SXin Li   VP8PredLuma16[4] = DC16NoTop;
1003*b2055c35SXin Li   VP8PredLuma16[5] = DC16NoLeft;
1004*b2055c35SXin Li   VP8PredLuma16[6] = DC16NoTopLeft;
1005*b2055c35SXin Li   VP8PredChroma8[0] = DC8uv;
1006*b2055c35SXin Li   VP8PredChroma8[1] = TM8uv;
1007*b2055c35SXin Li   VP8PredChroma8[2] = VE8uv;
1008*b2055c35SXin Li   VP8PredChroma8[3] = HE8uv;
1009*b2055c35SXin Li   VP8PredChroma8[4] = DC8uvNoTop;
1010*b2055c35SXin Li   VP8PredChroma8[5] = DC8uvNoLeft;
1011*b2055c35SXin Li   VP8PredChroma8[6] = DC8uvNoTopLeft;
1012*b2055c35SXin Li }
1013*b2055c35SXin Li 
1014*b2055c35SXin Li #else  // !WEBP_USE_MSA
1015*b2055c35SXin Li 
1016*b2055c35SXin Li WEBP_DSP_INIT_STUB(VP8DspInitMSA)
1017*b2055c35SXin Li 
1018*b2055c35SXin Li #endif  // WEBP_USE_MSA
1019