git.sesse.net Git - ffmpeg/blob - libavcodec/mips/hevc_lpf_sao_msa.c

   1 /*
   2  * Copyright (c) 2015 -2017 Manojkumar Bhosale (Manojkumar.Bhosale@imgtec.com)
   3  *
   4  * This file is part of FFmpeg.
   5  *
   6  * FFmpeg is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU Lesser General Public
   8  * License as published by the Free Software Foundation; either
   9  * version 2.1 of the License, or (at your option) any later version.
  10  *
  11  * FFmpeg is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14  * Lesser General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU Lesser General Public
  17  * License along with FFmpeg; if not, write to the Free Software
  18  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  19  */
  20
  21 #include "libavutil/mips/generic_macros_msa.h"
  22 #include "libavcodec/mips/hevcdsp_mips.h"
  23
  24 static void hevc_loopfilter_luma_hor_msa(uint8_t *src, int32_t stride,
  25                                          int32_t beta, int32_t *tc,
  26                                          uint8_t *p_is_pcm, uint8_t *q_is_pcm)
  27 {
  28     uint8_t *p3 = src - (stride << 2);
  29     uint8_t *p2 = src - ((stride << 1) + stride);
  30     uint8_t *p1 = src - (stride << 1);
  31     uint8_t *p0 = src - stride;
  32     uint8_t *q0 = src;
  33     uint8_t *q1 = src + stride;
  34     uint8_t *q2 = src + (stride << 1);
  35     uint8_t *q3 = src + (stride << 1) + stride;
  36     uint8_t flag0, flag1;
  37     int32_t dp00, dq00, dp30, dq30, d00, d30;
  38     int32_t d0030, d0434;
  39     int32_t dp04, dq04, dp34, dq34, d04, d34;
  40     int32_t tc0, p_is_pcm0, q_is_pcm0, beta30, beta20, tc250;
  41     int32_t tc4, p_is_pcm4, q_is_pcm4, tc254, tmp;
  42     uint64_t dst_val0, dst_val1;
  43     v16u8 dst0, dst1, dst2, dst3, dst4, dst5;
  44     v2i64 cmp0, cmp1, cmp2, p_is_pcm_vec, q_is_pcm_vec;
  45     v2i64 cmp3;
  46     v8u16 temp0, temp1;
  47     v8i16 temp2;
  48     v8i16 tc_pos, tc_neg;
  49     v8i16 diff0, diff1, delta0, delta1, delta2, abs_delta0;
  50     v16i8 zero = { 0 };
  51     v8u16 p3_src, p2_src, p1_src, p0_src, q0_src, q1_src, q2_src, q3_src;
  52
  53     dp00 = abs(p2[0] - (p1[0] << 1) + p0[0]);
  54     dq00 = abs(q2[0] - (q1[0] << 1) + q0[0]);
  55     dp30 = abs(p2[3] - (p1[3] << 1) + p0[3]);
  56     dq30 = abs(q2[3] - (q1[3] << 1) + q0[3]);
  57     d00 = dp00 + dq00;
  58     d30 = dp30 + dq30;
  59     dp04 = abs(p2[4] - (p1[4] << 1) + p0[4]);
  60     dq04 = abs(q2[4] - (q1[4] << 1) + q0[4]);
  61     dp34 = abs(p2[7] - (p1[7] << 1) + p0[7]);
  62     dq34 = abs(q2[7] - (q1[7] << 1) + q0[7]);
  63     d04 = dp04 + dq04;
  64     d34 = dp34 + dq34;
  65
  66     p_is_pcm0 = p_is_pcm[0];
  67     p_is_pcm4 = p_is_pcm[1];
  68     q_is_pcm0 = q_is_pcm[0];
  69     q_is_pcm4 = q_is_pcm[1];
  70
  71     cmp0 = __msa_fill_d(p_is_pcm0);
  72     cmp1 = __msa_fill_d(p_is_pcm4);
  73     p_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
  74     p_is_pcm_vec = __msa_ceqi_d(p_is_pcm_vec, 0);
  75
  76     d0030 = (d00 + d30) >= beta;
  77     d0434 = (d04 + d34) >= beta;
  78
  79     cmp0 = (v2i64) __msa_fill_w(d0030);
  80     cmp1 = (v2i64) __msa_fill_w(d0434);
  81     cmp3 = (v2i64) __msa_ilvev_w((v4i32) cmp1, (v4i32) cmp0);
  82     cmp3 = (v2i64) __msa_ceqi_w((v4i32) cmp3, 0);
  83
  84     if ((!p_is_pcm0 || !p_is_pcm4 || !q_is_pcm0 || !q_is_pcm4) &&
  85         (!d0030 || !d0434)) {
  86         p3_src = LD_UH(p3);
  87         p2_src = LD_UH(p2);
  88         p1_src = LD_UH(p1);
  89         p0_src = LD_UH(p0);
  90
  91         cmp0 = __msa_fill_d(q_is_pcm0);
  92         cmp1 = __msa_fill_d(q_is_pcm4);
  93         q_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
  94         q_is_pcm_vec = __msa_ceqi_d(q_is_pcm_vec, 0);
  95
  96         tc0 = tc[0];
  97         beta30 = beta >> 3;
  98         beta20 = beta >> 2;
  99         tc250 = ((tc0 * 5 + 1) >> 1);
 100         tc4 = tc[1];
 101         tc254 = ((tc4 * 5 + 1) >> 1);
 102
 103         cmp0 = (v2i64) __msa_fill_h(tc0);
 104         cmp1 = (v2i64) __msa_fill_h(tc4);
 105
 106         ILVR_B4_UH(zero, p3_src, zero, p2_src, zero, p1_src, zero, p0_src,
 107                    p3_src, p2_src, p1_src, p0_src);
 108         q0_src = LD_UH(q0);
 109         q1_src = LD_UH(q1);
 110         q2_src = LD_UH(q2);
 111         q3_src = LD_UH(q3);
 112
 113         flag0 = abs(p3[0] - p0[0]) + abs(q3[0] - q0[0]) < beta30 &&
 114                 abs(p0[0] - q0[0]) < tc250;
 115         flag0 = flag0 && (abs(p3[3] - p0[3]) + abs(q3[3] - q0[3]) < beta30 &&
 116                 abs(p0[3] - q0[3]) < tc250 && (d00 << 1) < beta20 &&
 117                 (d30 << 1) < beta20);
 118
 119         tc_pos = (v8i16) __msa_ilvev_d(cmp1, cmp0);
 120         ILVR_B4_UH(zero, q0_src, zero, q1_src, zero, q2_src, zero, q3_src,
 121                    q0_src, q1_src, q2_src, q3_src);
 122         flag1 = abs(p3[4] - p0[4]) + abs(q3[4] - q0[4]) < beta30 &&
 123                 abs(p0[4] - q0[4]) < tc254;
 124         flag1 = flag1 && (abs(p3[7] - p0[7]) + abs(q3[7] - q0[7]) < beta30 &&
 125                 abs(p0[7] - q0[7]) < tc254 && (d04 << 1) < beta20 &&
 126                 (d34 << 1) < beta20);
 127
 128         cmp0 = (v2i64) __msa_fill_w(flag0);
 129         cmp1 = (v2i64) __msa_fill_w(flag1);
 130         cmp2 = (v2i64) __msa_ilvev_w((v4i32) cmp1, (v4i32) cmp0);
 131         cmp2 = (v2i64) __msa_ceqi_w((v4i32) cmp2, 0);
 132
 133         if (flag0 && flag1) { /* strong only */
 134             /* strong filter */
 135             tc_pos <<= 1;
 136             tc_neg = -tc_pos;
 137
 138             /* p part */
 139             temp0 = (p1_src + p0_src + q0_src);
 140             temp1 = ((p3_src + p2_src) << 1) + p2_src + temp0;
 141             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 142             temp2 = (v8i16) (temp1 - p2_src);
 143             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 144             dst0 = (v16u8) (temp2 + (v8i16) p2_src);
 145
 146             temp1 = temp0 + p2_src;
 147             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 2);
 148             temp2 = (v8i16) (temp1 - p1_src);
 149             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 150             dst1 = (v16u8) (temp2 + (v8i16) p1_src);
 151
 152             temp1 = (temp0 << 1) + p2_src + q1_src;
 153             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 154             temp2 = (v8i16) (temp1 - p0_src);
 155             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 156             dst2 = (v16u8) (temp2 + (v8i16) p0_src);
 157
 158             dst0 = __msa_bmz_v(dst0, (v16u8) p2_src, (v16u8) p_is_pcm_vec);
 159             dst1 = __msa_bmz_v(dst1, (v16u8) p1_src, (v16u8) p_is_pcm_vec);
 160             dst2 = __msa_bmz_v(dst2, (v16u8) p0_src, (v16u8) p_is_pcm_vec);
 161
 162             /* q part */
 163             temp0 = (q1_src + p0_src + q0_src);
 164
 165             temp1 = ((q3_src + q2_src) << 1) + q2_src + temp0;
 166             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 167             temp2 = (v8i16) (temp1 - q2_src);
 168             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 169             dst5 = (v16u8) (temp2 + (v8i16) q2_src);
 170
 171             temp1 = temp0 + q2_src;
 172             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 2);
 173             temp2 = (v8i16) (temp1 - q1_src);
 174             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 175             dst4 = (v16u8) (temp2 + (v8i16) q1_src);
 176
 177             temp1 = (temp0 << 1) + p1_src + q2_src;
 178             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 179             temp2 = (v8i16) (temp1 - q0_src);
 180             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 181             dst3 = (v16u8) (temp2 + (v8i16) q0_src);
 182
 183             dst3 = __msa_bmz_v(dst3, (v16u8) q0_src, (v16u8) q_is_pcm_vec);
 184             dst4 = __msa_bmz_v(dst4, (v16u8) q1_src, (v16u8) q_is_pcm_vec);
 185             dst5 = __msa_bmz_v(dst5, (v16u8) q2_src, (v16u8) q_is_pcm_vec);
 186
 187             /* pack results to 8 bit */
 188             PCKEV_B2_UB(dst1, dst0, dst3, dst2, dst0, dst1);
 189             dst2 = (v16u8) __msa_pckev_b((v16i8) dst5, (v16i8) dst4);
 190
 191             /* pack src to 8 bit */
 192             PCKEV_B2_UB(p1_src, p2_src, q0_src, p0_src, dst3, dst4);
 193             dst5 = (v16u8) __msa_pckev_b((v16i8) q2_src, (v16i8) q1_src);
 194
 195             dst0 = __msa_bmz_v(dst0, dst3, (v16u8) cmp3);
 196             dst1 = __msa_bmz_v(dst1, dst4, (v16u8) cmp3);
 197             dst2 = __msa_bmz_v(dst2, dst5, (v16u8) cmp3);
 198
 199             dst_val0 = __msa_copy_u_d((v2i64) dst2, 0);
 200             dst_val1 = __msa_copy_u_d((v2i64) dst2, 1);
 201
 202             ST8x4_UB(dst0, dst1, p2, stride);
 203             p2 += (4 * stride);
 204             SD(dst_val0, p2);
 205             p2 += stride;
 206             SD(dst_val1, p2);
 207             /* strong filter ends */
 208         } else if (flag0 == flag1) { /* weak only */
 209             /* weak filter */
 210             tc_neg = -tc_pos;
 211
 212             diff0 = (v8i16) (q0_src - p0_src);
 213             diff1 = (v8i16) (q1_src - p1_src);
 214             diff0 = (diff0 << 3) + diff0;
 215             diff1 = (diff1 << 1) + diff1;
 216             delta0 = diff0 - diff1;
 217             delta0 = __msa_srari_h(delta0, 4);
 218
 219             temp1 = (v8u16) ((tc_pos << 3) + (tc_pos << 1));
 220             abs_delta0 = __msa_add_a_h(delta0, (v8i16) zero);
 221             abs_delta0 = (v8u16) abs_delta0 < temp1;
 222
 223             delta0 = CLIP_SH(delta0, tc_neg, tc_pos);
 224
 225             temp0 = (v8u16) (delta0 + p0_src);
 226             temp0 = (v8u16) CLIP_SH_0_255(temp0);
 227             temp0 = (v8u16) __msa_bmz_v((v16u8) temp0, (v16u8) p0_src,
 228                                         (v16u8) p_is_pcm_vec);
 229
 230             temp2 = (v8i16) (q0_src - delta0);
 231             temp2 = CLIP_SH_0_255(temp2);
 232             temp2 = (v8i16) __msa_bmz_v((v16u8) temp2, (v16u8) q0_src,
 233                                         (v16u8) q_is_pcm_vec);
 234
 235             p_is_pcm_vec = ~p_is_pcm_vec;
 236             q_is_pcm_vec = ~q_is_pcm_vec;
 237             tmp = (beta + (beta >> 1)) >> 3;
 238             cmp0 = __msa_fill_d(dp00 + dp30 < tmp);
 239             cmp1 = __msa_fill_d(dp04 + dp34 < tmp);
 240             cmp0 = __msa_ilvev_d(cmp1, cmp0);
 241             cmp0 = __msa_ceqi_d(cmp0, 0);
 242             p_is_pcm_vec = p_is_pcm_vec | cmp0;
 243
 244             cmp0 = __msa_fill_d(dq00 + dq30 < tmp);
 245             cmp1 = __msa_fill_d(dq04 + dq34 < tmp);
 246             cmp0 = __msa_ilvev_d(cmp1, cmp0);
 247             cmp0 = __msa_ceqi_d(cmp0, 0);
 248             q_is_pcm_vec = q_is_pcm_vec | cmp0;
 249
 250             tc_pos >>= 1;
 251             tc_neg = -tc_pos;
 252
 253             delta1 = (v8i16) __msa_aver_u_h(p2_src, p0_src);
 254             delta1 -= (v8i16) p1_src;
 255             delta1 += delta0;
 256             delta1 >>= 1;
 257             delta1 = CLIP_SH(delta1, tc_neg, tc_pos);
 258             delta1 = (v8i16) p1_src + (v8i16) delta1;
 259             delta1 = CLIP_SH_0_255(delta1);
 260             delta1 = (v8i16) __msa_bmnz_v((v16u8) delta1, (v16u8) p1_src,
 261                                           (v16u8) p_is_pcm_vec);
 262
 263             delta2 = (v8i16) __msa_aver_u_h(q0_src, q2_src);
 264             delta2 = delta2 - (v8i16) q1_src;
 265             delta2 = delta2 - delta0;
 266             delta2 = delta2 >> 1;
 267             delta2 = CLIP_SH(delta2, tc_neg, tc_pos);
 268             delta2 = (v8i16) q1_src + (v8i16) delta2;
 269             delta2 = CLIP_SH_0_255(delta2);
 270             delta2 = (v8i16) __msa_bmnz_v((v16u8) delta2, (v16u8) q1_src,
 271                                           (v16u8) q_is_pcm_vec);
 272
 273             dst1 = (v16u8) __msa_bmz_v((v16u8) delta1, (v16u8) p1_src,
 274                                        (v16u8) abs_delta0);
 275             dst2 = (v16u8) __msa_bmz_v((v16u8) temp0, (v16u8) p0_src,
 276                                        (v16u8) abs_delta0);
 277             dst3 = (v16u8) __msa_bmz_v((v16u8) temp2, (v16u8) q0_src,
 278                                        (v16u8) abs_delta0);
 279             dst4 = (v16u8) __msa_bmz_v((v16u8) delta2, (v16u8) q1_src,
 280                                        (v16u8) abs_delta0);
 281             /* pack results to 8 bit */
 282             PCKEV_B2_UB(dst2, dst1, dst4, dst3, dst0, dst1);
 283
 284             /* pack src to 8 bit */
 285             PCKEV_B2_UB(p0_src, p1_src, q1_src, q0_src, dst2, dst3);
 286
 287             dst0 = __msa_bmz_v(dst0, dst2, (v16u8) cmp3);
 288             dst1 = __msa_bmz_v(dst1, dst3, (v16u8) cmp3);
 289
 290             p2 += stride;
 291             ST8x4_UB(dst0, dst1, p2, stride);
 292             /* weak filter ends */
 293         } else { /* strong + weak */
 294             /* strong filter */
 295             tc_pos <<= 1;
 296             tc_neg = -tc_pos;
 297
 298             /* p part */
 299             temp0 = (p1_src + p0_src + q0_src);
 300             temp1 = ((p3_src + p2_src) << 1) + p2_src + temp0;
 301             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 302             temp2 = (v8i16) (temp1 - p2_src);
 303             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 304             dst0 = (v16u8) (temp2 + (v8i16) p2_src);
 305
 306             temp1 = temp0 + p2_src;
 307             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 2);
 308             temp2 = (v8i16) (temp1 - p1_src);
 309             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 310             dst1 = (v16u8) (temp2 + (v8i16) p1_src);
 311
 312             temp1 = (temp0 << 1) + p2_src + q1_src;
 313             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 314             temp2 = (v8i16) (temp1 - p0_src);
 315             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 316             dst2 = (v16u8) (temp2 + (v8i16) p0_src);
 317
 318             dst0 = __msa_bmz_v(dst0, (v16u8) p2_src, (v16u8) p_is_pcm_vec);
 319             dst1 = __msa_bmz_v(dst1, (v16u8) p1_src, (v16u8) p_is_pcm_vec);
 320             dst2 = __msa_bmz_v(dst2, (v16u8) p0_src, (v16u8) p_is_pcm_vec);
 321
 322             /* q part */
 323             temp0 = (q1_src + p0_src + q0_src);
 324
 325             temp1 = ((q3_src + q2_src) << 1) + q2_src + temp0;
 326             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 327             temp2 = (v8i16) (temp1 - q2_src);
 328             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 329             dst5 = (v16u8) (temp2 + (v8i16) q2_src);
 330
 331             temp1 = temp0 + q2_src;
 332             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 2);
 333             temp2 = (v8i16) (temp1 - q1_src);
 334             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 335             dst4 = (v16u8) (temp2 + (v8i16) q1_src);
 336
 337             temp1 = (temp0 << 1) + p1_src + q2_src;
 338             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 339             temp2 = (v8i16) (temp1 - q0_src);
 340             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 341             dst3 = (v16u8) (temp2 + (v8i16) q0_src);
 342
 343             dst3 = __msa_bmz_v(dst3, (v16u8) q0_src, (v16u8) q_is_pcm_vec);
 344             dst4 = __msa_bmz_v(dst4, (v16u8) q1_src, (v16u8) q_is_pcm_vec);
 345             dst5 = __msa_bmz_v(dst5, (v16u8) q2_src, (v16u8) q_is_pcm_vec);
 346
 347             /* pack strong results to 8 bit */
 348             PCKEV_B2_UB(dst1, dst0, dst3, dst2, dst0, dst1);
 349             dst2 = (v16u8) __msa_pckev_b((v16i8) dst5, (v16i8) dst4);
 350             /* strong filter ends */
 351
 352             /* weak filter */
 353             tc_pos >>= 1;
 354             tc_neg = -tc_pos;
 355
 356             diff0 = (v8i16) (q0_src - p0_src);
 357             diff1 = (v8i16) (q1_src - p1_src);
 358             diff0 = (diff0 << 3) + diff0;
 359             diff1 = (diff1 << 1) + diff1;
 360             delta0 = diff0 - diff1;
 361             delta0 = __msa_srari_h(delta0, 4);
 362
 363             temp1 = (v8u16) ((tc_pos << 3) + (tc_pos << 1));
 364             abs_delta0 = __msa_add_a_h(delta0, (v8i16) zero);
 365             abs_delta0 = (v8u16) abs_delta0 < temp1;
 366
 367             delta0 = CLIP_SH(delta0, tc_neg, tc_pos);
 368
 369             temp0 = (v8u16) (delta0 + p0_src);
 370             temp0 = (v8u16) CLIP_SH_0_255(temp0);
 371             temp0 = (v8u16) __msa_bmz_v((v16u8) temp0, (v16u8) p0_src,
 372                                         (v16u8) p_is_pcm_vec);
 373
 374             temp2 = (v8i16) (q0_src - delta0);
 375             temp2 = CLIP_SH_0_255(temp2);
 376             temp2 = (v8i16) __msa_bmz_v((v16u8) temp2, (v16u8) q0_src,
 377                                         (v16u8) q_is_pcm_vec);
 378
 379             p_is_pcm_vec = ~p_is_pcm_vec;
 380             q_is_pcm_vec = ~q_is_pcm_vec;
 381             tmp = (beta + (beta >> 1)) >> 3;
 382             cmp0 = __msa_fill_d(dp00 + dp30 < tmp);
 383             cmp1 = __msa_fill_d(dp04 + dp34 < tmp);
 384             cmp0 = __msa_ilvev_d(cmp1, cmp0);
 385             p_is_pcm_vec = p_is_pcm_vec | __msa_ceqi_d(cmp0, 0);
 386
 387             cmp0 = __msa_fill_d(dq00 + dq30 < tmp);
 388             cmp1 = __msa_fill_d(dq04 + dq34 < tmp);
 389             cmp0 = __msa_ilvev_d(cmp1, cmp0);
 390             q_is_pcm_vec = q_is_pcm_vec | __msa_ceqi_d(cmp0, 0);
 391
 392             tc_pos >>= 1;
 393             tc_neg = -tc_pos;
 394
 395             delta1 = (v8i16) __msa_aver_u_h(p2_src, p0_src);
 396             delta1 -= (v8i16) p1_src;
 397             delta1 += delta0;
 398             delta1 >>= 1;
 399             delta1 = CLIP_SH(delta1, tc_neg, tc_pos);
 400             delta1 = (v8i16) p1_src + (v8i16) delta1;
 401             delta1 = CLIP_SH_0_255(delta1);
 402             delta1 = (v8i16) __msa_bmnz_v((v16u8) delta1, (v16u8) p1_src,
 403                                           (v16u8) p_is_pcm_vec);
 404
 405             delta2 = (v8i16) __msa_aver_u_h(q0_src, q2_src);
 406             delta2 = delta2 - (v8i16) q1_src;
 407             delta2 = delta2 - delta0;
 408             delta2 = delta2 >> 1;
 409             delta2 = CLIP_SH(delta2, tc_neg, tc_pos);
 410             delta2 = (v8i16) q1_src + (v8i16) delta2;
 411             delta2 = CLIP_SH_0_255(delta2);
 412             delta2 = (v8i16) __msa_bmnz_v((v16u8) delta2, (v16u8) q1_src,
 413                                           (v16u8) q_is_pcm_vec);
 414
 415             delta1 = (v8i16) __msa_bmz_v((v16u8) delta1, (v16u8) p1_src,
 416                                          (v16u8) abs_delta0);
 417             temp0 = (v8u16) __msa_bmz_v((v16u8) temp0, (v16u8) p0_src,
 418                                         (v16u8) abs_delta0);
 419             temp2 = (v8i16) __msa_bmz_v((v16u8) temp2, (v16u8) q0_src,
 420                                         (v16u8) abs_delta0);
 421             delta2 = (v8i16) __msa_bmz_v((v16u8) delta2, (v16u8) q1_src,
 422                                          (v16u8) abs_delta0);
 423             /* weak filter ends */
 424
 425             /* pack weak results to 8 bit */
 426             PCKEV_B2_UB(delta1, p2_src, temp2, temp0, dst3, dst4);
 427             dst5 = (v16u8) __msa_pckev_b((v16i8) q2_src, (v16i8) delta2);
 428
 429             /* select between weak or strong */
 430             dst0 = __msa_bmnz_v(dst0, dst3, (v16u8) cmp2);
 431             dst1 = __msa_bmnz_v(dst1, dst4, (v16u8) cmp2);
 432             dst2 = __msa_bmnz_v(dst2, dst5, (v16u8) cmp2);
 433
 434             /* pack src to 8 bit */
 435             PCKEV_B2_UB(p1_src, p2_src, q0_src, p0_src, dst3, dst4);
 436             dst5 = (v16u8) __msa_pckev_b((v16i8) q2_src, (v16i8) q1_src);
 437
 438             dst0 = __msa_bmz_v(dst0, dst3, (v16u8) cmp3);
 439             dst1 = __msa_bmz_v(dst1, dst4, (v16u8) cmp3);
 440             dst2 = __msa_bmz_v(dst2, dst5, (v16u8) cmp3);
 441
 442             dst_val0 = __msa_copy_u_d((v2i64) dst2, 0);
 443             dst_val1 = __msa_copy_u_d((v2i64) dst2, 1);
 444
 445             ST8x4_UB(dst0, dst1, p2, stride);
 446             p2 += (4 * stride);
 447             SD(dst_val0, p2);
 448             p2 += stride;
 449             SD(dst_val1, p2);
 450         }
 451     }
 452 }
 453
 454 static void hevc_loopfilter_luma_ver_msa(uint8_t *src, int32_t stride,
 455                                          int32_t beta, int32_t *tc,
 456                                          uint8_t *p_is_pcm, uint8_t *q_is_pcm)
 457 {
 458     uint8_t *p3 = src;
 459     uint8_t *p2 = src + 3 * stride;
 460     uint8_t *p1 = src + (stride << 2);
 461     uint8_t *p0 = src + 7 * stride;
 462     uint8_t flag0, flag1;
 463     uint16_t tmp0, tmp1;
 464     uint32_t tmp2, tmp3;
 465     int32_t dp00, dq00, dp30, dq30, d00, d30;
 466     int32_t d0030, d0434;
 467     int32_t dp04, dq04, dp34, dq34, d04, d34;
 468     int32_t tc0, p_is_pcm0, q_is_pcm0, beta30, beta20, tc250;
 469     int32_t tc4, p_is_pcm4, q_is_pcm4, tc254, tmp;
 470     v16u8 dst0, dst1, dst2, dst3, dst4, dst5, dst6, dst7;
 471     v2i64 cmp0, cmp1, cmp2, p_is_pcm_vec, q_is_pcm_vec;
 472     v2i64 cmp3;
 473     v8u16 temp0, temp1;
 474     v8i16 temp2;
 475     v8i16 tc_pos, tc_neg;
 476     v8i16 diff0, diff1, delta0, delta1, delta2, abs_delta0;
 477     v16i8 zero = { 0 };
 478     v8u16 p3_src, p2_src, p1_src, p0_src, q0_src, q1_src, q2_src, q3_src;
 479
 480     dp00 = abs(p3[-3] - (p3[-2] << 1) + p3[-1]);
 481     dq00 = abs(p3[2] - (p3[1] << 1) + p3[0]);
 482     dp30 = abs(p2[-3] - (p2[-2] << 1) + p2[-1]);
 483     dq30 = abs(p2[2] - (p2[1] << 1) + p2[0]);
 484     d00 = dp00 + dq00;
 485     d30 = dp30 + dq30;
 486     p_is_pcm0 = p_is_pcm[0];
 487     q_is_pcm0 = q_is_pcm[0];
 488
 489     dp04 = abs(p1[-3] - (p1[-2] << 1) + p1[-1]);
 490     dq04 = abs(p1[2] - (p1[1] << 1) + p1[0]);
 491     dp34 = abs(p0[-3] - (p0[-2] << 1) + p0[-1]);
 492     dq34 = abs(p0[2] - (p0[1] << 1) + p0[0]);
 493     d04 = dp04 + dq04;
 494     d34 = dp34 + dq34;
 495     p_is_pcm4 = p_is_pcm[1];
 496     q_is_pcm4 = q_is_pcm[1];
 497
 498     cmp0 = __msa_fill_d(p_is_pcm0);
 499     cmp1 = __msa_fill_d(p_is_pcm4);
 500     p_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
 501     p_is_pcm_vec = __msa_ceqi_d(p_is_pcm_vec, 0);
 502
 503     d0030 = (d00 + d30) >= beta;
 504     d0434 = (d04 + d34) >= beta;
 505
 506     cmp0 = __msa_fill_d(d0030);
 507     cmp1 = __msa_fill_d(d0434);
 508     cmp3 = __msa_ilvev_d(cmp1, cmp0);
 509     cmp3 = (v2i64) __msa_ceqi_d(cmp3, 0);
 510
 511     if ((!p_is_pcm0 || !p_is_pcm4 || !q_is_pcm0 || !q_is_pcm4) &&
 512         (!d0030 || !d0434)) {
 513         src -= 4;
 514         LD_UH8(src, stride, p3_src, p2_src, p1_src, p0_src, q0_src, q1_src,
 515                q2_src, q3_src);
 516
 517         cmp0 = __msa_fill_d(q_is_pcm0);
 518         cmp1 = __msa_fill_d(q_is_pcm4);
 519         q_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
 520         q_is_pcm_vec = __msa_ceqi_d(q_is_pcm_vec, 0);
 521
 522         tc0 = tc[0];
 523         beta30 = beta >> 3;
 524         beta20 = beta >> 2;
 525         tc250 = ((tc0 * 5 + 1) >> 1);
 526
 527         tc4 = tc[1];
 528         tc254 = ((tc4 * 5 + 1) >> 1);
 529         cmp0 = (v2i64) __msa_fill_h(tc0 << 1);
 530         cmp1 = (v2i64) __msa_fill_h(tc4 << 1);
 531         tc_pos = (v8i16) __msa_ilvev_d(cmp1, cmp0);
 532
 533         TRANSPOSE8x8_UB_UH(p3_src, p2_src, p1_src, p0_src, q0_src, q1_src,
 534                            q2_src, q3_src, p3_src, p2_src, p1_src, p0_src,
 535                            q0_src, q1_src, q2_src, q3_src);
 536
 537         flag0 = abs(p3[-4] - p3[-1]) + abs(p3[3] - p3[0]) < beta30 &&
 538                 abs(p3[-1] - p3[0]) < tc250;
 539         flag0 = flag0 && (abs(p2[-4] - p2[-1]) + abs(p2[3] - p2[0]) < beta30 &&
 540                 abs(p2[-1] - p2[0]) < tc250 && (d00 << 1) < beta20 &&
 541                 (d30 << 1) < beta20);
 542         cmp0 = __msa_fill_d(flag0);
 543         ILVR_B4_UH(zero, p3_src, zero, p2_src, zero, p1_src, zero, p0_src,
 544                    p3_src, p2_src, p1_src, p0_src);
 545
 546         flag1 = abs(p1[-4] - p1[-1]) + abs(p1[3] - p1[0]) < beta30 &&
 547                 abs(p1[-1] - p1[0]) < tc254;
 548         flag1 = flag1 && (abs(p0[-4] - p0[-1]) + abs(p0[3] - p0[0]) < beta30 &&
 549                 abs(p0[-1] - p0[0]) < tc254 && (d04 << 1) < beta20 &&
 550                 (d34 << 1) < beta20);
 551         ILVR_B4_UH(zero, q0_src, zero, q1_src, zero, q2_src, zero, q3_src,
 552                    q0_src, q1_src, q2_src, q3_src);
 553
 554         cmp1 = __msa_fill_d(flag1);
 555         cmp2 = __msa_ilvev_d(cmp1, cmp0);
 556         cmp2 = __msa_ceqi_d(cmp2, 0);
 557
 558         if (flag0 && flag1) { /* strong only */
 559             /* strong filter */
 560             tc_neg = -tc_pos;
 561
 562             /* p part */
 563             temp0 = (p1_src + p0_src + q0_src);
 564
 565             temp1 = ((p3_src + p2_src) << 1) + p2_src + temp0;
 566             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 567             temp2 = (v8i16) (temp1 - p2_src);
 568             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 569             dst0 = (v16u8) (temp2 + (v8i16) p2_src);
 570
 571             temp1 = temp0 + p2_src;
 572             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 2);
 573             temp2 = (v8i16) (temp1 - p1_src);
 574             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 575             dst1 = (v16u8) (temp2 + (v8i16) p1_src);
 576
 577             temp1 = (temp0 << 1) + p2_src + q1_src;
 578             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 579             temp2 = (v8i16) (temp1 - p0_src);
 580             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 581             dst2 = (v16u8) (temp2 + (v8i16) p0_src);
 582
 583             dst0 = __msa_bmz_v(dst0, (v16u8) p2_src, (v16u8) p_is_pcm_vec);
 584             dst1 = __msa_bmz_v(dst1, (v16u8) p1_src, (v16u8) p_is_pcm_vec);
 585             dst2 = __msa_bmz_v(dst2, (v16u8) p0_src, (v16u8) p_is_pcm_vec);
 586
 587             /* q part */
 588             temp0 = (q1_src + p0_src + q0_src);
 589             temp1 = ((q3_src + q2_src) << 1) + q2_src + temp0;
 590             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 591             temp2 = (v8i16) (temp1 - q2_src);
 592             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 593             dst5 = (v16u8) (temp2 + (v8i16) q2_src);
 594
 595             temp1 = temp0 + q2_src;
 596             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 2);
 597             temp2 = (v8i16) (temp1 - q1_src);
 598             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 599             dst4 = (v16u8) (temp2 + (v8i16) q1_src);
 600
 601             temp1 = (temp0 << 1) + p1_src + q2_src;
 602             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 603             temp2 = (v8i16) (temp1 - q0_src);
 604             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 605             dst3 = (v16u8) (temp2 + (v8i16) q0_src);
 606
 607             dst3 = __msa_bmz_v(dst3, (v16u8) q0_src, (v16u8) q_is_pcm_vec);
 608             dst4 = __msa_bmz_v(dst4, (v16u8) q1_src, (v16u8) q_is_pcm_vec);
 609             dst5 = __msa_bmz_v(dst5, (v16u8) q2_src, (v16u8) q_is_pcm_vec);
 610             /* strong filter ends */
 611         } else if (flag0 == flag1) { /* weak only */
 612             /* weak filter */
 613             tc_pos >>= 1;
 614             tc_neg = -tc_pos;
 615
 616             diff0 = (v8i16) (q0_src - p0_src);
 617             diff1 = (v8i16) (q1_src - p1_src);
 618             diff0 = (diff0 << 3) + diff0;
 619             diff1 = (diff1 << 1) + diff1;
 620             delta0 = diff0 - diff1;
 621             delta0 = __msa_srari_h(delta0, 4);
 622
 623             temp1 = (v8u16) ((tc_pos << 3) + (tc_pos << 1));
 624             abs_delta0 = __msa_add_a_h(delta0, (v8i16) zero);
 625             abs_delta0 = (v8u16) abs_delta0 < temp1;
 626
 627             delta0 = CLIP_SH(delta0, tc_neg, tc_pos);
 628             temp0 = (v8u16) (delta0 + p0_src);
 629             temp0 = (v8u16) CLIP_SH_0_255(temp0);
 630             temp0 = (v8u16) __msa_bmz_v((v16u8) temp0, (v16u8) p0_src,
 631                                         (v16u8) p_is_pcm_vec);
 632
 633             temp2 = (v8i16) (q0_src - delta0);
 634             temp2 = CLIP_SH_0_255(temp2);
 635             temp2 = (v8i16) __msa_bmz_v((v16u8) temp2, (v16u8) q0_src,
 636                                         (v16u8) q_is_pcm_vec);
 637
 638             tmp = ((beta + (beta >> 1)) >> 3);
 639             cmp0 = __msa_fill_d(!p_is_pcm0 && ((dp00 + dp30) < tmp));
 640             cmp1 = __msa_fill_d(!p_is_pcm4 && ((dp04 + dp34) < tmp));
 641             p_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
 642             p_is_pcm_vec = __msa_ceqi_d(p_is_pcm_vec, 0);
 643
 644             cmp0 = (v2i64) __msa_fill_h((!q_is_pcm0) && (dq00 + dq30 < tmp));
 645             cmp1 = (v2i64) __msa_fill_h((!q_is_pcm4) && (dq04 + dq34 < tmp));
 646             q_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
 647             q_is_pcm_vec = __msa_ceqi_d(q_is_pcm_vec, 0);
 648
 649             tc_pos >>= 1;
 650             tc_neg = -tc_pos;
 651
 652             delta1 = (v8i16) __msa_aver_u_h(p2_src, p0_src);
 653             delta1 -= (v8i16) p1_src;
 654             delta1 += delta0;
 655             delta1 >>= 1;
 656             delta1 = CLIP_SH(delta1, tc_neg, tc_pos);
 657             delta1 = (v8i16) p1_src + (v8i16) delta1;
 658             delta1 = CLIP_SH_0_255(delta1);
 659             delta1 = (v8i16) __msa_bmnz_v((v16u8) delta1, (v16u8) p1_src,
 660                                           (v16u8) p_is_pcm_vec);
 661
 662             delta2 = (v8i16) __msa_aver_u_h(q0_src, q2_src);
 663             delta2 = delta2 - (v8i16) q1_src;
 664             delta2 = delta2 - delta0;
 665             delta2 = delta2 >> 1;
 666             delta2 = CLIP_SH(delta2, tc_neg, tc_pos);
 667             delta2 = (v8i16) q1_src + (v8i16) delta2;
 668             delta2 = CLIP_SH_0_255(delta2);
 669             delta2 = (v8i16) __msa_bmnz_v((v16u8) delta2, (v16u8) q1_src,
 670                                           (v16u8) q_is_pcm_vec);
 671
 672             dst0 = __msa_bmz_v((v16u8) delta1, (v16u8) p1_src,
 673                                (v16u8) abs_delta0);
 674             dst1 = __msa_bmz_v((v16u8) temp0, (v16u8) p0_src,
 675                                (v16u8) abs_delta0);
 676             dst2 = __msa_bmz_v((v16u8) temp2, (v16u8) q0_src,
 677                                (v16u8) abs_delta0);
 678             dst3 = __msa_bmz_v((v16u8) delta2, (v16u8) q1_src,
 679                                (v16u8) abs_delta0);
 680             /* weak filter ends */
 681
 682             dst0 = __msa_bmz_v(dst0, (v16u8) p1_src, (v16u8) cmp3);
 683             dst1 = __msa_bmz_v(dst1, (v16u8) p0_src, (v16u8) cmp3);
 684             dst2 = __msa_bmz_v(dst2, (v16u8) q0_src, (v16u8) cmp3);
 685             dst3 = __msa_bmz_v(dst3, (v16u8) q1_src, (v16u8) cmp3);
 686
 687             PCKEV_B2_UB(dst2, dst0, dst3, dst1, dst0, dst1);
 688
 689             /* transpose */
 690             ILVRL_B2_UB(dst1, dst0, dst4, dst5);
 691             ILVRL_H2_UB(dst5, dst4, dst0, dst1);
 692
 693             src += 2;
 694
 695             tmp2 = __msa_copy_u_w((v4i32) dst0, 0);
 696             tmp3 = __msa_copy_u_w((v4i32) dst0, 1);
 697             SW(tmp2, src);
 698             src += stride;
 699             SW(tmp3, src);
 700             src += stride;
 701
 702             tmp2 = __msa_copy_u_w((v4i32) dst0, 2);
 703             tmp3 = __msa_copy_u_w((v4i32) dst0, 3);
 704             SW(tmp2, src);
 705             src += stride;
 706             SW(tmp3, src);
 707             src += stride;
 708
 709             tmp2 = __msa_copy_u_w((v4i32) dst1, 0);
 710             tmp3 = __msa_copy_u_w((v4i32) dst1, 1);
 711             SW(tmp2, src);
 712             src += stride;
 713             SW(tmp3, src);
 714             src += stride;
 715
 716             tmp2 = __msa_copy_u_w((v4i32) dst1, 2);
 717             tmp3 = __msa_copy_u_w((v4i32) dst1, 3);
 718             SW(tmp2, src);
 719             src += stride;
 720             SW(tmp3, src);
 721
 722             return;
 723         } else { /* strong + weak */
 724             /* strong filter */
 725             tc_neg = -tc_pos;
 726
 727             /* p part */
 728             temp0 = (p1_src + p0_src + q0_src);
 729
 730             temp1 = ((p3_src + p2_src) << 1) + p2_src + temp0;
 731             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 732             temp2 = (v8i16) (temp1 - p2_src);
 733             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 734             dst0 = (v16u8) (temp2 + (v8i16) p2_src);
 735
 736             temp1 = temp0 + p2_src;
 737             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 2);
 738             temp2 = (v8i16) (temp1 - p1_src);
 739             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 740             dst1 = (v16u8) (temp2 + (v8i16) p1_src);
 741
 742             temp1 = (temp0 << 1) + p2_src + q1_src;
 743             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 744             temp2 = (v8i16) (temp1 - p0_src);
 745             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 746             dst2 = (v16u8) (temp2 + (v8i16) p0_src);
 747
 748             dst0 = __msa_bmz_v(dst0, (v16u8) p2_src, (v16u8) p_is_pcm_vec);
 749             dst1 = __msa_bmz_v(dst1, (v16u8) p1_src, (v16u8) p_is_pcm_vec);
 750             dst2 = __msa_bmz_v(dst2, (v16u8) p0_src, (v16u8) p_is_pcm_vec);
 751
 752             /* q part */
 753             temp0 = (q1_src + p0_src + q0_src);
 754             temp1 = ((q3_src + q2_src) << 1) + q2_src + temp0;
 755             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 756             temp2 = (v8i16) (temp1 - q2_src);
 757             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 758             dst5 = (v16u8) (temp2 + (v8i16) q2_src);
 759
 760             temp1 = temp0 + q2_src;
 761             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 2);
 762             temp2 = (v8i16) (temp1 - q1_src);
 763             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 764             dst4 = (v16u8) (temp2 + (v8i16) q1_src);
 765
 766             temp1 = (temp0 << 1) + p1_src + q2_src;
 767             temp1 = (v8u16) __msa_srari_h((v8i16) temp1, 3);
 768             temp2 = (v8i16) (temp1 - q0_src);
 769             temp2 = CLIP_SH(temp2, tc_neg, tc_pos);
 770             dst3 = (v16u8) (temp2 + (v8i16) q0_src);
 771
 772             dst3 = __msa_bmz_v(dst3, (v16u8) q0_src, (v16u8) q_is_pcm_vec);
 773             dst4 = __msa_bmz_v(dst4, (v16u8) q1_src, (v16u8) q_is_pcm_vec);
 774             dst5 = __msa_bmz_v(dst5, (v16u8) q2_src, (v16u8) q_is_pcm_vec);
 775             /* strong filter ends */
 776
 777             /* weak filter */
 778             tc_pos >>= 1;
 779             tc_neg = -tc_pos;
 780
 781             diff0 = (v8i16) (q0_src - p0_src);
 782             diff1 = (v8i16) (q1_src - p1_src);
 783             diff0 = (diff0 << 3) + diff0;
 784             diff1 = (diff1 << 1) + diff1;
 785             delta0 = diff0 - diff1;
 786             delta0 = __msa_srari_h(delta0, 4);
 787
 788             temp1 = (v8u16) ((tc_pos << 3) + (tc_pos << 1));
 789             abs_delta0 = __msa_add_a_h(delta0, (v8i16) zero);
 790             abs_delta0 = (v8u16) abs_delta0 < temp1;
 791
 792             delta0 = CLIP_SH(delta0, tc_neg, tc_pos);
 793
 794             temp0 = (v8u16) (delta0 + p0_src);
 795             temp0 = (v8u16) CLIP_SH_0_255(temp0);
 796             temp0 = (v8u16) __msa_bmz_v((v16u8) temp0, (v16u8) p0_src,
 797                                         (v16u8) p_is_pcm_vec);
 798
 799             temp2 = (v8i16) (q0_src - delta0);
 800             temp2 = CLIP_SH_0_255(temp2);
 801             temp2 = (v8i16) __msa_bmz_v((v16u8) temp2, (v16u8) q0_src,
 802                                         (v16u8) q_is_pcm_vec);
 803
 804             tmp = (beta + (beta >> 1)) >> 3;
 805             cmp0 = __msa_fill_d(!p_is_pcm0 && ((dp00 + dp30) < tmp));
 806             cmp1 = __msa_fill_d(!p_is_pcm4 && ((dp04 + dp34) < tmp));
 807             p_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
 808             p_is_pcm_vec = __msa_ceqi_d(p_is_pcm_vec, 0);
 809
 810             cmp0 = (v2i64) __msa_fill_h((!q_is_pcm0) && (dq00 + dq30 < tmp));
 811             cmp1 = (v2i64) __msa_fill_h((!q_is_pcm4) && (dq04 + dq34 < tmp));
 812             q_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
 813             q_is_pcm_vec = __msa_ceqi_d(q_is_pcm_vec, 0);
 814
 815             tc_pos >>= 1;
 816             tc_neg = -tc_pos;
 817
 818             delta1 = (v8i16) __msa_aver_u_h(p2_src, p0_src);
 819             delta1 -= (v8i16) p1_src;
 820             delta1 += delta0;
 821             delta1 >>= 1;
 822             delta1 = CLIP_SH(delta1, tc_neg, tc_pos);
 823             delta1 = (v8i16) p1_src + (v8i16) delta1;
 824             delta1 = CLIP_SH_0_255(delta1);
 825             delta1 = (v8i16) __msa_bmnz_v((v16u8) delta1, (v16u8) p1_src,
 826                                           (v16u8) p_is_pcm_vec);
 827
 828             delta2 = (v8i16) __msa_aver_u_h(q0_src, q2_src);
 829             delta2 = delta2 - (v8i16) q1_src;
 830             delta2 = delta2 - delta0;
 831             delta2 = delta2 >> 1;
 832             delta2 = CLIP_SH(delta2, tc_neg, tc_pos);
 833             delta2 = (v8i16) q1_src + (v8i16) delta2;
 834             delta2 = CLIP_SH_0_255(delta2);
 835             delta2 = (v8i16) __msa_bmnz_v((v16u8) delta2, (v16u8) q1_src,
 836                                           (v16u8) q_is_pcm_vec);
 837             delta1 = (v8i16) __msa_bmz_v((v16u8) delta1, (v16u8) p1_src,
 838                                          (v16u8) abs_delta0);
 839             temp0 = (v8u16) __msa_bmz_v((v16u8) temp0, (v16u8) p0_src,
 840                                         (v16u8) abs_delta0);
 841             temp2 = (v8i16) __msa_bmz_v((v16u8) temp2, (v16u8) q0_src,
 842                                         (v16u8) abs_delta0);
 843             delta2 = (v8i16) __msa_bmz_v((v16u8) delta2, (v16u8) q1_src,
 844                                          (v16u8) abs_delta0);
 845             /* weak filter ends*/
 846
 847             /* select between weak or strong */
 848             dst2 = __msa_bmnz_v(dst2, (v16u8) temp0, (v16u8) cmp2);
 849             dst3 = __msa_bmnz_v(dst3, (v16u8) temp2, (v16u8) cmp2);
 850             dst1 = __msa_bmnz_v(dst1, (v16u8) delta1, (v16u8) cmp2);
 851             dst4 = __msa_bmnz_v(dst4, (v16u8) delta2, (v16u8) cmp2);
 852             dst0 = __msa_bmnz_v(dst0, (v16u8) p2_src, (v16u8) cmp2);
 853             dst5 = __msa_bmnz_v(dst5, (v16u8) q2_src, (v16u8) cmp2);
 854         }
 855
 856         dst0 = __msa_bmz_v(dst0, (v16u8) p2_src, (v16u8) cmp3);
 857         dst1 = __msa_bmz_v(dst1, (v16u8) p1_src, (v16u8) cmp3);
 858         dst2 = __msa_bmz_v(dst2, (v16u8) p0_src, (v16u8) cmp3);
 859         dst3 = __msa_bmz_v(dst3, (v16u8) q0_src, (v16u8) cmp3);
 860         dst4 = __msa_bmz_v(dst4, (v16u8) q1_src, (v16u8) cmp3);
 861         dst5 = __msa_bmz_v(dst5, (v16u8) q2_src, (v16u8) cmp3);
 862
 863         /* pack results to 8 bit */
 864         PCKEV_B4_UB(dst2, dst0, dst3, dst1, dst4, dst4, dst5, dst5, dst0, dst1,
 865                     dst2, dst3);
 866
 867         /* transpose */
 868         ILVRL_B2_UB(dst1, dst0, dst4, dst5);
 869         ILVRL_B2_UB(dst3, dst2, dst6, dst7);
 870         ILVRL_H2_UB(dst5, dst4, dst0, dst1);
 871         ILVRL_H2_UB(dst7, dst6, dst2, dst3);
 872
 873         src += 1;
 874
 875         tmp2 = __msa_copy_u_w((v4i32) dst0, 0);
 876         tmp3 = __msa_copy_u_w((v4i32) dst0, 1);
 877         tmp0 = __msa_copy_u_h((v8i16) dst2, 0);
 878         tmp1 = __msa_copy_u_h((v8i16) dst2, 2);
 879         SW(tmp2, src);
 880         SH(tmp0, src + 4);
 881         src += stride;
 882         SW(tmp3, src);
 883         SH(tmp1, src + 4);
 884         src += stride;
 885
 886         tmp2 = __msa_copy_u_w((v4i32) dst0, 2);
 887         tmp3 = __msa_copy_u_w((v4i32) dst0, 3);
 888         tmp0 = __msa_copy_u_h((v8i16) dst2, 4);
 889         tmp1 = __msa_copy_u_h((v8i16) dst2, 6);
 890         SW(tmp2, src);
 891         SH(tmp0, src + 4);
 892         src += stride;
 893         SW(tmp3, src);
 894         SH(tmp1, src + 4);
 895         src += stride;
 896
 897         tmp2 = __msa_copy_u_w((v4i32) dst1, 0);
 898         tmp3 = __msa_copy_u_w((v4i32) dst1, 1);
 899         tmp0 = __msa_copy_u_h((v8i16) dst3, 0);
 900         tmp1 = __msa_copy_u_h((v8i16) dst3, 2);
 901         SW(tmp2, src);
 902         SH(tmp0, src + 4);
 903         src += stride;
 904         SW(tmp3, src);
 905         SH(tmp1, src + 4);
 906         src += stride;
 907
 908         tmp2 = __msa_copy_u_w((v4i32) dst1, 2);
 909         tmp3 = __msa_copy_u_w((v4i32) dst1, 3);
 910         tmp0 = __msa_copy_u_h((v8i16) dst3, 4);
 911         tmp1 = __msa_copy_u_h((v8i16) dst3, 6);
 912         SW(tmp2, src);
 913         SH(tmp0, src + 4);
 914         src += stride;
 915         SW(tmp3, src);
 916         SH(tmp1, src + 4);
 917     }
 918 }
 919
 920 static void hevc_loopfilter_chroma_hor_msa(uint8_t *src, int32_t stride,
 921                                            int32_t *tc, uint8_t *p_is_pcm,
 922                                            uint8_t *q_is_pcm)
 923 {
 924     uint8_t *p1_ptr = src - (stride << 1);
 925     uint8_t *p0_ptr = src - stride;
 926     uint8_t *q0_ptr = src;
 927     uint8_t *q1_ptr = src + stride;
 928     v2i64 cmp0, cmp1, p_is_pcm_vec, q_is_pcm_vec;
 929     v8u16 p1, p0, q0, q1;
 930     v8i16 tc_pos, tc_neg;
 931     v16i8 zero = { 0 };
 932     v8i16 temp0, temp1, delta;
 933
 934     if (!(tc[0] <= 0) || !(tc[1] <= 0)) {
 935         cmp0 = (v2i64) __msa_fill_h(tc[0]);
 936         cmp1 = (v2i64) __msa_fill_h(tc[1]);
 937         tc_pos = (v8i16) __msa_ilvev_d(cmp1, cmp0);
 938         tc_neg = -tc_pos;
 939
 940         cmp0 = __msa_fill_d(p_is_pcm[0]);
 941         cmp1 = __msa_fill_d(p_is_pcm[1]);
 942         p_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
 943         p_is_pcm_vec = __msa_ceqi_d(p_is_pcm_vec, 0);
 944
 945         cmp0 = __msa_fill_d(q_is_pcm[0]);
 946         cmp1 = __msa_fill_d(q_is_pcm[1]);
 947         q_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
 948         q_is_pcm_vec = __msa_ceqi_d(q_is_pcm_vec, 0);
 949
 950         p1 = LD_UH(p1_ptr);
 951         p0 = LD_UH(p0_ptr);
 952         q0 = LD_UH(q0_ptr);
 953         q1 = LD_UH(q1_ptr);
 954
 955         ILVR_B4_UH(zero, p1, zero, p0, zero, q0, zero, q1, p1, p0, q0, q1);
 956
 957         temp0 = (v8i16) (q0 - p0);
 958         temp1 = (v8i16) (p1 - q1);
 959         temp0 <<= 2;
 960         temp0 += temp1;
 961         delta = __msa_srari_h((v8i16) temp0, 3);
 962         delta = CLIP_SH(delta, tc_neg, tc_pos);
 963
 964         temp0 = (v8i16) ((v8i16) p0 + delta);
 965         temp0 = CLIP_SH_0_255(temp0);
 966         temp0 = (v8i16) __msa_bmz_v((v16u8) temp0, (v16u8) p0,
 967                                     (v16u8) p_is_pcm_vec);
 968
 969         temp1 = (v8i16) ((v8i16) q0 - delta);
 970         temp1 = CLIP_SH_0_255(temp1);
 971         temp1 = (v8i16) __msa_bmz_v((v16u8) temp1, (v16u8) q0,
 972                                     (v16u8) q_is_pcm_vec);
 973
 974         tc_pos = (v8i16) __msa_clei_s_d((v2i64) tc_pos, 0);
 975         temp0 = (v8i16) __msa_bmnz_v((v16u8) temp0, (v16u8) p0, (v16u8) tc_pos);
 976         temp1 = (v8i16) __msa_bmnz_v((v16u8) temp1, (v16u8) q0, (v16u8) tc_pos);
 977
 978         temp0 = (v8i16) __msa_pckev_b((v16i8) temp1, (v16i8) temp0);
 979         ST8x2_UB(temp0, p0_ptr, stride);
 980     }
 981 }
 982
 983 static void hevc_loopfilter_chroma_ver_msa(uint8_t *src, int32_t stride,
 984                                            int32_t *tc, uint8_t *p_is_pcm,
 985                                            uint8_t *q_is_pcm)
 986 {
 987     v2i64 cmp0, cmp1, p_is_pcm_vec, q_is_pcm_vec;
 988     v16u8 src0, src1, src2, src3, src4, src5, src6, src7;
 989     v8u16 p1, p0, q0, q1;
 990     v8i16 tc_pos, tc_neg;
 991     v16i8 zero = { 0 };
 992     v8i16 temp0, temp1, delta;
 993
 994     if (!(tc[0] <= 0) || !(tc[1] <= 0)) {
 995         cmp0 = (v2i64) __msa_fill_h(tc[0]);
 996         cmp1 = (v2i64) __msa_fill_h(tc[1]);
 997         tc_pos = (v8i16) __msa_ilvev_d(cmp1, cmp0);
 998         tc_neg = -tc_pos;
 999
1000         cmp0 = __msa_fill_d(p_is_pcm[0]);
1001         cmp1 = __msa_fill_d(p_is_pcm[1]);
1002         p_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
1003         p_is_pcm_vec = __msa_ceqi_d(p_is_pcm_vec, 0);
1004
1005         cmp0 = __msa_fill_d(q_is_pcm[0]);
1006         cmp1 = __msa_fill_d(q_is_pcm[1]);
1007         q_is_pcm_vec = __msa_ilvev_d(cmp1, cmp0);
1008         q_is_pcm_vec = __msa_ceqi_d(q_is_pcm_vec, 0);
1009
1010         src -= 2;
1011         LD_UB8(src, stride, src0, src1, src2, src3, src4, src5, src6, src7);
1012         TRANSPOSE8x4_UB_UH(src0, src1, src2, src3, src4, src5, src6, src7,
1013                            p1, p0, q0, q1);
1014         ILVR_B4_UH(zero, p1, zero, p0, zero, q0, zero, q1, p1, p0, q0, q1);
1015
1016         temp0 = (v8i16) (q0 - p0);
1017         temp1 = (v8i16) (p1 - q1);
1018         temp0 <<= 2;
1019         temp0 += temp1;
1020         delta = __msa_srari_h((v8i16) temp0, 3);
1021         delta = CLIP_SH(delta, tc_neg, tc_pos);
1022
1023         temp0 = (v8i16) ((v8i16) p0 + delta);
1024         temp0 = CLIP_SH_0_255(temp0);
1025         temp0 = (v8i16) __msa_bmz_v((v16u8) temp0, (v16u8) p0,
1026                                     (v16u8) p_is_pcm_vec);
1027
1028         temp1 = (v8i16) ((v8i16) q0 - delta);
1029         temp1 = CLIP_SH_0_255(temp1);
1030         temp1 = (v8i16) __msa_bmz_v((v16u8) temp1, (v16u8) q0,
1031                                     (v16u8) q_is_pcm_vec);
1032
1033         tc_pos = (v8i16) __msa_clei_s_d((v2i64) tc_pos, 0);
1034         temp0 = (v8i16) __msa_bmnz_v((v16u8) temp0, (v16u8) p0, (v16u8) tc_pos);
1035         temp1 = (v8i16) __msa_bmnz_v((v16u8) temp1, (v16u8) q0, (v16u8) tc_pos);
1036
1037         temp0 = (v8i16) __msa_ilvev_b((v16i8) temp1, (v16i8) temp0);
1038
1039         src += 1;
1040         ST2x4_UB(temp0, 0, src, stride);
1041         src += (4 * stride);
1042         ST2x4_UB(temp0, 4, src, stride);
1043     }
1044 }
1045
1046 static void hevc_sao_band_filter_4width_msa(uint8_t *dst, int32_t dst_stride,
1047                                             uint8_t *src, int32_t src_stride,
1048                                             int32_t sao_left_class,
1049                                             int16_t *sao_offset_val,
1050                                             int32_t height)
1051 {
1052     v16u8 src0, src1, src2, src3;
1053     v16i8 src0_r, src1_r;
1054     v16i8 offset, offset_val, mask;
1055     v16i8 dst0, offset0, offset1;
1056     v16i8 zero = { 0 };
1057
1058     offset_val = LD_SB(sao_offset_val + 1);
1059     offset_val = (v16i8) __msa_pckev_d((v2i64) offset_val, (v2i64) offset_val);
1060
1061     offset_val = __msa_pckev_b(offset_val, offset_val);
1062     offset1 = (v16i8) __msa_insve_w((v4i32) zero, 3, (v4i32) offset_val);
1063     offset0 = __msa_sld_b(offset1, zero, 28 - ((sao_left_class) & 31));
1064     offset1 = __msa_sld_b(zero, offset1, 28 - ((sao_left_class) & 31));
1065
1066     /* load in advance. */
1067     LD_UB4(src, src_stride, src0, src1, src2, src3);
1068
1069     if (!((sao_left_class > 12) & (sao_left_class < 29))) {
1070         SWAP(offset0, offset1);
1071     }
1072
1073     for (height -= 4; height; height -= 4) {
1074         src += (4 * src_stride);
1075
1076         ILVEV_D2_SB(src0, src1, src2, src3, src0_r, src1_r);
1077
1078         src0_r = (v16i8) __msa_pckev_w((v4i32) src1_r, (v4i32) src0_r);
1079         mask = __msa_srli_b(src0_r, 3);
1080         offset = __msa_vshf_b(mask, offset1, offset0);
1081
1082         src0_r = (v16i8) __msa_xori_b((v16u8) src0_r, 128);
1083         dst0 = __msa_adds_s_b(src0_r, offset);
1084         dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1085
1086         /* load in advance. */
1087         LD_UB4(src, src_stride, src0, src1, src2, src3);
1088
1089         /* store results */
1090         ST4x4_UB(dst0, dst0, 0, 1, 2, 3, dst, dst_stride);
1091         dst += (4 * dst_stride);
1092     }
1093
1094     ILVEV_D2_SB(src0, src1, src2, src3, src0_r, src1_r);
1095
1096     src0_r = (v16i8) __msa_pckev_w((v4i32) src1_r, (v4i32) src0_r);
1097     mask = __msa_srli_b(src0_r, 3);
1098     offset = __msa_vshf_b(mask, offset1, offset0);
1099
1100     src0_r = (v16i8) __msa_xori_b((v16u8) src0_r, 128);
1101     dst0 = __msa_adds_s_b(src0_r, offset);
1102     dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1103
1104     /* store results */
1105     ST4x4_UB(dst0, dst0, 0, 1, 2, 3, dst, dst_stride);
1106 }
1107
1108 static void hevc_sao_band_filter_8width_msa(uint8_t *dst, int32_t dst_stride,
1109                                             uint8_t *src, int32_t src_stride,
1110                                             int32_t sao_left_class,
1111                                             int16_t *sao_offset_val,
1112                                             int32_t height)
1113 {
1114     v16u8 src0, src1, src2, src3;
1115     v16i8 src0_r, src1_r, mask0, mask1;
1116     v16i8 offset_mask0, offset_mask1, offset_val;
1117     v16i8 offset0, offset1, dst0, dst1;
1118     v16i8 zero = { 0 };
1119
1120     offset_val = LD_SB(sao_offset_val + 1);
1121     offset_val = (v16i8) __msa_pckev_d((v2i64) offset_val, (v2i64) offset_val);
1122     offset_val = __msa_pckev_b(offset_val, offset_val);
1123     offset1 = (v16i8) __msa_insve_w((v4i32) zero, 3, (v4i32) offset_val);
1124     offset0 = __msa_sld_b(offset1, zero, 28 - ((sao_left_class) & 31));
1125     offset1 = __msa_sld_b(zero, offset1, 28 - ((sao_left_class) & 31));
1126
1127     /* load in advance. */
1128     LD_UB4(src, src_stride, src0, src1, src2, src3);
1129
1130     if (!((sao_left_class > 12) & (sao_left_class < 29))) {
1131         SWAP(offset0, offset1);
1132     }
1133
1134     for (height -= 4; height; height -= 4) {
1135         src += src_stride << 2;
1136
1137         ILVR_D2_SB(src1, src0, src3, src2, src0_r, src1_r);
1138
1139         mask0 = __msa_srli_b(src0_r, 3);
1140         mask1 = __msa_srli_b(src1_r, 3);
1141
1142         offset_mask0 = __msa_vshf_b(mask0, offset1, offset0);
1143         offset_mask1 = __msa_vshf_b(mask1, offset1, offset0);
1144
1145         /* load in advance. */
1146         LD_UB4(src, src_stride, src0, src1, src2, src3);
1147
1148         XORI_B2_128_SB(src0_r, src1_r);
1149
1150         dst0 = __msa_adds_s_b(src0_r, offset_mask0);
1151         dst1 = __msa_adds_s_b(src1_r, offset_mask1);
1152
1153         XORI_B2_128_SB(dst0, dst1);
1154
1155         /* store results */
1156         ST8x4_UB(dst0, dst1, dst, dst_stride);
1157         dst += dst_stride << 2;
1158     }
1159
1160     ILVR_D2_SB(src1, src0, src3, src2, src0_r, src1_r);
1161
1162     mask0 = __msa_srli_b(src0_r, 3);
1163     mask1 = __msa_srli_b(src1_r, 3);
1164
1165     offset_mask0 = __msa_vshf_b(mask0, offset1, offset0);
1166     offset_mask1 = __msa_vshf_b(mask1, offset1, offset0);
1167
1168     XORI_B2_128_SB(src0_r, src1_r);
1169
1170     dst0 = __msa_adds_s_b(src0_r, offset_mask0);
1171     dst1 = __msa_adds_s_b(src1_r, offset_mask1);
1172
1173     XORI_B2_128_SB(dst0, dst1);
1174
1175     /* store results */
1176     ST8x4_UB(dst0, dst1, dst, dst_stride);
1177 }
1178
1179 static void hevc_sao_band_filter_16multiple_msa(uint8_t *dst,
1180                                                 int32_t dst_stride,
1181                                                 uint8_t *src,
1182                                                 int32_t src_stride,
1183                                                 int32_t sao_left_class,
1184                                                 int16_t *sao_offset_val,
1185                                                 int32_t width, int32_t height)
1186 {
1187     int32_t w_cnt;
1188     v16u8 src0, src1, src2, src3;
1189     v16i8 out0, out1, out2, out3;
1190     v16i8 mask0, mask1, mask2, mask3;
1191     v16i8 tmp0, tmp1, tmp2, tmp3, offset_val;
1192     v16i8 offset0, offset1;
1193     v16i8 zero = { 0 };
1194
1195     offset_val = LD_SB(sao_offset_val + 1);
1196     offset_val = (v16i8) __msa_pckev_d((v2i64) offset_val, (v2i64) offset_val);
1197     offset_val = __msa_pckev_b(offset_val, offset_val);
1198     offset1 = (v16i8) __msa_insve_w((v4i32) zero, 3, (v4i32) offset_val);
1199     offset0 = __msa_sld_b(offset1, zero, 28 - ((sao_left_class) & 31));
1200     offset1 = __msa_sld_b(zero, offset1, 28 - ((sao_left_class) & 31));
1201
1202     if (!((sao_left_class > 12) & (sao_left_class < 29))) {
1203         SWAP(offset0, offset1);
1204     }
1205
1206     while (height > 0) {
1207         /* load in advance */
1208         LD_UB4(src, src_stride, src0, src1, src2, src3);
1209
1210         for (w_cnt = 16; w_cnt < width; w_cnt += 16) {
1211             mask0 = __msa_srli_b((v16i8) src0, 3);
1212             mask1 = __msa_srli_b((v16i8) src1, 3);
1213             mask2 = __msa_srli_b((v16i8) src2, 3);
1214             mask3 = __msa_srli_b((v16i8) src3, 3);
1215
1216             VSHF_B2_SB(offset0, offset1, offset0, offset1, mask0, mask1,
1217                        tmp0, tmp1);
1218             VSHF_B2_SB(offset0, offset1, offset0, offset1, mask2, mask3,
1219                        tmp2, tmp3);
1220             XORI_B4_128_UB(src0, src1, src2, src3);
1221
1222             out0 = __msa_adds_s_b((v16i8) src0, tmp0);
1223             out1 = __msa_adds_s_b((v16i8) src1, tmp1);
1224             out2 = __msa_adds_s_b((v16i8) src2, tmp2);
1225             out3 = __msa_adds_s_b((v16i8) src3, tmp3);
1226
1227             /* load for next iteration */
1228             LD_UB4(src + w_cnt, src_stride, src0, src1, src2, src3);
1229
1230             XORI_B4_128_SB(out0, out1, out2, out3);
1231
1232             ST_SB4(out0, out1, out2, out3, dst + w_cnt - 16, dst_stride);
1233         }
1234
1235         mask0 = __msa_srli_b((v16i8) src0, 3);
1236         mask1 = __msa_srli_b((v16i8) src1, 3);
1237         mask2 = __msa_srli_b((v16i8) src2, 3);
1238         mask3 = __msa_srli_b((v16i8) src3, 3);
1239
1240         VSHF_B2_SB(offset0, offset1, offset0, offset1, mask0, mask1, tmp0,
1241                    tmp1);
1242         VSHF_B2_SB(offset0, offset1, offset0, offset1, mask2, mask3, tmp2,
1243                    tmp3);
1244         XORI_B4_128_UB(src0, src1, src2, src3);
1245
1246         out0 = __msa_adds_s_b((v16i8) src0, tmp0);
1247         out1 = __msa_adds_s_b((v16i8) src1, tmp1);
1248         out2 = __msa_adds_s_b((v16i8) src2, tmp2);
1249         out3 = __msa_adds_s_b((v16i8) src3, tmp3);
1250
1251         XORI_B4_128_SB(out0, out1, out2, out3);
1252
1253         ST_SB4(out0, out1, out2, out3, dst + w_cnt - 16, dst_stride);
1254
1255         src += src_stride << 2;
1256         dst += dst_stride << 2;
1257         height -= 4;
1258     }
1259 }
1260
1261 static void hevc_sao_edge_filter_0degree_4width_msa(uint8_t *dst,
1262                                                     int32_t dst_stride,
1263                                                     uint8_t *src,
1264                                                     int32_t src_stride,
1265                                                     int16_t *sao_offset_val,
1266                                                     int32_t height)
1267 {
1268     uint32_t dst_val0, dst_val1;
1269     v16u8 cmp_minus10, diff_minus10, diff_minus11, src_minus10, src_minus11;
1270     v16i8 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1271     v16i8 sao_offset = LD_SB(sao_offset_val);
1272     v16i8 src_plus10, offset, src0, dst0;
1273     v16u8 const1 = (v16u8) __msa_ldi_b(1);
1274     v16i8 zero = { 0 };
1275
1276     sao_offset = __msa_pckev_b(sao_offset, sao_offset);
1277     src -= 1;
1278
1279     /* load in advance */
1280     LD_UB2(src, src_stride, src_minus10, src_minus11);
1281
1282     for (height -= 2; height; height -= 2) {
1283         src += (2 * src_stride);
1284
1285         src_minus10 = (v16u8) __msa_pckev_d((v2i64) src_minus11,
1286                                             (v2i64) src_minus10);
1287
1288         src0 = (v16i8) __msa_sldi_b(zero, (v16i8) src_minus10, 1);
1289         src_plus10 = (v16i8) __msa_sldi_b(zero, (v16i8) src_minus10, 2);
1290
1291         cmp_minus10 = ((v16u8) src0 == src_minus10);
1292         diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1293         cmp_minus10 = (src_minus10 < (v16u8) src0);
1294         diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1295
1296         cmp_minus10 = ((v16u8) src0 == (v16u8) src_plus10);
1297         diff_minus11 = __msa_nor_v(cmp_minus10, cmp_minus10);
1298         cmp_minus10 = ((v16u8) src_plus10 < (v16u8) src0);
1299         diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus10);
1300
1301         offset = (v16i8) diff_minus10 + (v16i8) diff_minus11 + 2;
1302
1303         /* load in advance */
1304         LD_UB2(src, src_stride, src_minus10, src_minus11);
1305
1306         VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset, offset,
1307                    offset, offset);
1308
1309         src0 = (v16i8) __msa_xori_b((v16u8) src0, 128);
1310         dst0 = __msa_adds_s_b(src0, offset);
1311         dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1312
1313         dst_val0 = __msa_copy_u_w((v4i32) dst0, 0);
1314         dst_val1 = __msa_copy_u_w((v4i32) dst0, 2);
1315         SW(dst_val0, dst);
1316         dst += dst_stride;
1317         SW(dst_val1, dst);
1318         dst += dst_stride;
1319     }
1320
1321     src_minus10 = (v16u8) __msa_pckev_d((v2i64) src_minus11,
1322                                         (v2i64) src_minus10);
1323
1324     src0 = (v16i8) __msa_sldi_b(zero, (v16i8) src_minus10, 1);
1325     src_plus10 = (v16i8) __msa_sldi_b(zero, (v16i8) src_minus10, 2);
1326
1327     cmp_minus10 = ((v16u8) src0 == src_minus10);
1328     diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1329     cmp_minus10 = (src_minus10 < (v16u8) src0);
1330     diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1331
1332     cmp_minus10 = ((v16u8) src0 == (v16u8) src_plus10);
1333     diff_minus11 = __msa_nor_v(cmp_minus10, cmp_minus10);
1334     cmp_minus10 = ((v16u8) src_plus10 < (v16u8) src0);
1335     diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus10);
1336
1337     offset = (v16i8) diff_minus10 + (v16i8) diff_minus11 + 2;
1338     VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset, offset,
1339                offset, offset);
1340
1341     src0 = (v16i8) __msa_xori_b((v16u8) src0, 128);
1342     dst0 = __msa_adds_s_b(src0, offset);
1343     dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1344
1345     dst_val0 = __msa_copy_u_w((v4i32) dst0, 0);
1346     dst_val1 = __msa_copy_u_w((v4i32) dst0, 2);
1347
1348     SW(dst_val0, dst);
1349     dst += dst_stride;
1350     SW(dst_val1, dst);
1351 }
1352
1353 static void hevc_sao_edge_filter_0degree_8width_msa(uint8_t *dst,
1354                                                     int32_t dst_stride,
1355                                                     uint8_t *src,
1356                                                     int32_t src_stride,
1357                                                     int16_t *sao_offset_val,
1358                                                     int32_t height)
1359 {
1360     uint64_t dst_val0, dst_val1;
1361     v16i8 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1362     v16u8 const1 = (v16u8) __msa_ldi_b(1);
1363     v16u8 cmp_minus10, diff_minus10, diff_minus11;
1364     v16u8 src0, src1, dst0, src_minus10, src_minus11, src_plus10, src_plus11;
1365     v16i8 offset, sao_offset = LD_SB(sao_offset_val);
1366
1367     sao_offset = __msa_pckev_b(sao_offset, sao_offset);
1368     src -= 1;
1369
1370     /* load in advance */
1371     LD_UB2(src, src_stride, src_minus10, src_minus11);
1372
1373     for (height -= 2; height; height -= 2) {
1374         src += (src_stride << 1);
1375
1376         SLDI_B2_0_UB(src_minus10, src_minus11, src0, src1, 1);
1377         SLDI_B2_0_UB(src_minus10, src_minus11, src_plus10, src_plus11, 2);
1378
1379         PCKEV_D2_UB(src_minus11, src_minus10, src_plus11, src_plus10,
1380                     src_minus10, src_plus10);
1381         src0 = (v16u8) __msa_pckev_d((v2i64) src1, (v2i64) src0);
1382
1383         cmp_minus10 = (src0 == src_minus10);
1384         diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1385         cmp_minus10 = (src_minus10 < src0);
1386         diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1387
1388         cmp_minus10 = (src0 == src_plus10);
1389         diff_minus11 = __msa_nor_v(cmp_minus10, cmp_minus10);
1390         cmp_minus10 = (src_plus10 < src0);
1391         diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus10);
1392
1393         offset = (v16i8) diff_minus10 + (v16i8) diff_minus11 + 2;
1394
1395         /* load in advance */
1396         LD_UB2(src, src_stride, src_minus10, src_minus11);
1397
1398         VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset, offset,
1399                    offset, offset);
1400
1401         src0 = __msa_xori_b(src0, 128);
1402         dst0 = (v16u8) __msa_adds_s_b((v16i8) src0, offset);
1403         dst0 = __msa_xori_b(dst0, 128);
1404
1405         dst_val0 = __msa_copy_u_d((v2i64) dst0, 0);
1406         dst_val1 = __msa_copy_u_d((v2i64) dst0, 1);
1407         SD(dst_val0, dst);
1408         dst += dst_stride;
1409         SD(dst_val1, dst);
1410         dst += dst_stride;
1411     }
1412
1413     SLDI_B2_0_UB(src_minus10, src_minus11, src0, src1, 1);
1414     SLDI_B2_0_UB(src_minus10, src_minus11, src_plus10, src_plus11, 2);
1415
1416     PCKEV_D2_UB(src_minus11, src_minus10, src_plus11, src_plus10, src_minus10,
1417                 src_plus10);
1418     src0 = (v16u8) __msa_pckev_d((v2i64) src1, (v2i64) src0);
1419
1420     cmp_minus10 = ((v16u8) src0 == src_minus10);
1421     diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1422     cmp_minus10 = (src_minus10 < (v16u8) src0);
1423     diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1424
1425     cmp_minus10 = (src0 ==  src_plus10);
1426     diff_minus11 = __msa_nor_v(cmp_minus10, cmp_minus10);
1427     cmp_minus10 = (src_plus10 < src0);
1428     diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus10);
1429
1430     offset = (v16i8) diff_minus10 + (v16i8) diff_minus11 + 2;
1431
1432     VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset, offset,
1433                offset, offset);
1434
1435     src0 = __msa_xori_b(src0, 128);
1436     dst0 = (v16u8) __msa_adds_s_b((v16i8) src0, offset);
1437     dst0 = __msa_xori_b(dst0, 128);
1438
1439     dst_val0 = __msa_copy_u_d((v2i64) dst0, 0);
1440     dst_val1 = __msa_copy_u_d((v2i64) dst0, 1);
1441     SD(dst_val0, dst);
1442     dst += dst_stride;
1443     SD(dst_val1, dst);
1444 }
1445
1446 static void hevc_sao_edge_filter_0degree_16multiple_msa(uint8_t *dst,
1447                                                         int32_t dst_stride,
1448                                                         uint8_t *src,
1449                                                         int32_t src_stride,
1450                                                         int16_t *sao_offset_val,
1451                                                         int32_t width,
1452                                                         int32_t height)
1453 {
1454     uint8_t *dst_ptr, *src_minus1;
1455     int32_t v_cnt;
1456     v16i8 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1457     v16u8 const1 = (v16u8) __msa_ldi_b(1);
1458     v16i8 sao_offset;
1459     v16u8 cmp_minus10, cmp_plus10, diff_minus10, diff_plus10, cmp_minus11;
1460     v16u8 cmp_plus11, diff_minus11, diff_plus11, cmp_minus12, cmp_plus12;
1461     v16u8 diff_minus12, diff_plus12, cmp_minus13, cmp_plus13, diff_minus13;
1462     v16u8 diff_plus13;
1463     v16u8 src10, src11, src12, src13, dst0, dst1, dst2, dst3;
1464     v16u8 src_minus10, src_minus11, src_minus12, src_minus13;
1465     v16i8 offset_mask0, offset_mask1, offset_mask2, offset_mask3;
1466     v16i8 src_zero0, src_zero1, src_zero2, src_zero3;
1467     v16i8 src_plus10, src_plus11, src_plus12, src_plus13;
1468
1469     sao_offset = LD_SB(sao_offset_val);
1470     sao_offset = __msa_pckev_b(sao_offset, sao_offset);
1471
1472     for (; height; height -= 4) {
1473         src_minus1 = src - 1;
1474         LD_UB4(src_minus1, src_stride,
1475                src_minus10, src_minus11, src_minus12, src_minus13);
1476
1477         for (v_cnt = 0; v_cnt < width; v_cnt += 16) {
1478             src_minus1 += 16;
1479             dst_ptr = dst + v_cnt;
1480             LD_UB4(src_minus1, src_stride, src10, src11, src12, src13);
1481
1482             SLDI_B2_SB(src10, src11, src_minus10, src_minus11, src_zero0,
1483                        src_zero1, 1);
1484             SLDI_B2_SB(src12, src13, src_minus12, src_minus13, src_zero2,
1485                        src_zero3, 1);
1486             SLDI_B2_SB(src10, src11, src_minus10, src_minus11, src_plus10,
1487                        src_plus11, 2);
1488             SLDI_B2_SB(src12, src13, src_minus12, src_minus13, src_plus12,
1489                        src_plus13, 2);
1490
1491             cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
1492             cmp_plus10 = ((v16u8) src_zero0 == (v16u8) src_plus10);
1493             cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
1494             cmp_plus11 = ((v16u8) src_zero1 == (v16u8) src_plus11);
1495             cmp_minus12 = ((v16u8) src_zero2 == src_minus12);
1496             cmp_plus12 = ((v16u8) src_zero2 == (v16u8) src_plus12);
1497             cmp_minus13 = ((v16u8) src_zero3 == src_minus13);
1498             cmp_plus13 = ((v16u8) src_zero3 == (v16u8) src_plus13);
1499
1500             diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1501             diff_plus10 = __msa_nor_v(cmp_plus10, cmp_plus10);
1502             diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
1503             diff_plus11 = __msa_nor_v(cmp_plus11, cmp_plus11);
1504             diff_minus12 = __msa_nor_v(cmp_minus12, cmp_minus12);
1505             diff_plus12 = __msa_nor_v(cmp_plus12, cmp_plus12);
1506             diff_minus13 = __msa_nor_v(cmp_minus13, cmp_minus13);
1507             diff_plus13 = __msa_nor_v(cmp_plus13, cmp_plus13);
1508
1509             cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
1510             cmp_plus10 = ((v16u8) src_plus10 < (v16u8) src_zero0);
1511             cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
1512             cmp_plus11 = ((v16u8) src_plus11 < (v16u8) src_zero1);
1513             cmp_minus12 = (src_minus12 < (v16u8) src_zero2);
1514             cmp_plus12 = ((v16u8) src_plus12 < (v16u8) src_zero2);
1515             cmp_minus13 = (src_minus13 < (v16u8) src_zero3);
1516             cmp_plus13 = ((v16u8) src_plus13 < (v16u8) src_zero3);
1517
1518             diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1519             diff_plus10 = __msa_bmnz_v(diff_plus10, const1, cmp_plus10);
1520             diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
1521             diff_plus11 = __msa_bmnz_v(diff_plus11, const1, cmp_plus11);
1522             diff_minus12 = __msa_bmnz_v(diff_minus12, const1, cmp_minus12);
1523             diff_plus12 = __msa_bmnz_v(diff_plus12, const1, cmp_plus12);
1524             diff_minus13 = __msa_bmnz_v(diff_minus13, const1, cmp_minus13);
1525             diff_plus13 = __msa_bmnz_v(diff_plus13, const1, cmp_plus13);
1526
1527             offset_mask0 = 2 + (v16i8) diff_minus10 + (v16i8) diff_plus10;
1528             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset_mask0,
1529                        offset_mask0, offset_mask0, offset_mask0);
1530             offset_mask1 = 2 + (v16i8) diff_minus11 + (v16i8) diff_plus11;
1531             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset_mask1,
1532                        offset_mask1, offset_mask1, offset_mask1);
1533             offset_mask2 = 2 + (v16i8) diff_minus12 + (v16i8) diff_plus12;
1534             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset_mask2,
1535                        offset_mask2, offset_mask2, offset_mask2);
1536             offset_mask3 = 2 + (v16i8) diff_minus13 + (v16i8) diff_plus13;
1537             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset_mask3,
1538                        offset_mask3, offset_mask3, offset_mask3);
1539
1540             XORI_B4_128_SB(src_zero0, src_zero1, src_zero2, src_zero3);
1541
1542             dst0 = (v16u8) __msa_adds_s_b((v16i8) src_zero0, offset_mask0);
1543             dst1 = (v16u8) __msa_adds_s_b((v16i8) src_zero1, offset_mask1);
1544             dst2 = (v16u8) __msa_adds_s_b((v16i8) src_zero2, offset_mask2);
1545             dst3 = (v16u8) __msa_adds_s_b((v16i8) src_zero3, offset_mask3);
1546
1547             XORI_B4_128_UB(dst0, dst1, dst2, dst3);
1548
1549             src_minus10 = src10;
1550             ST_UB(dst0, dst_ptr);
1551             src_minus11 = src11;
1552             ST_UB(dst1, dst_ptr + dst_stride);
1553             src_minus12 = src12;
1554             ST_UB(dst2, dst_ptr + (dst_stride << 1));
1555             src_minus13 = src13;
1556             ST_UB(dst3, dst_ptr + (dst_stride * 3));
1557         }
1558
1559         src += (src_stride << 2);
1560         dst += (dst_stride << 2);
1561     }
1562 }
1563
1564 static void hevc_sao_edge_filter_90degree_4width_msa(uint8_t *dst,
1565                                                      int32_t dst_stride,
1566                                                      uint8_t *src,
1567                                                      int32_t src_stride,
1568                                                      int16_t *sao_offset_val,
1569                                                      int32_t height)
1570 {
1571     uint32_t dst_val0, dst_val1;
1572     v16i8 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1573     v16u8 const1 = (v16u8) __msa_ldi_b(1);
1574     v16i8 dst0;
1575     v16i8 sao_offset = LD_SB(sao_offset_val);
1576     v16u8 cmp_minus10, diff_minus10, cmp_minus11, diff_minus11;
1577     v16u8 src_minus10, src_minus11, src10, src11;
1578     v16i8 src_zero0, src_zero1;
1579     v16i8 offset;
1580     v8i16 offset_mask0, offset_mask1;
1581
1582     sao_offset = __msa_pckev_b(sao_offset, sao_offset);
1583
1584     /* load in advance */
1585     LD_UB2(src - src_stride, src_stride, src_minus10, src_minus11);
1586     LD_UB2(src + src_stride, src_stride, src10, src11);
1587
1588     for (height -= 2; height; height -= 2) {
1589         src += (src_stride << 1);
1590
1591         src_minus10 = (v16u8) __msa_ilvr_b((v16i8) src10, (v16i8) src_minus10);
1592         src_zero0 = __msa_ilvr_b((v16i8) src_minus11, (v16i8) src_minus11);
1593         src_minus11 = (v16u8) __msa_ilvr_b((v16i8) src11, (v16i8) src_minus11);
1594         src_zero1 = __msa_ilvr_b((v16i8) src10, (v16i8) src10);
1595
1596         cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
1597         diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1598         cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
1599         diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1600
1601         cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
1602         diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
1603         cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
1604         diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
1605
1606         offset_mask0 = (v8i16) (__msa_hadd_u_h(diff_minus10, diff_minus10) + 2);
1607         offset_mask1 = (v8i16) (__msa_hadd_u_h(diff_minus11, diff_minus11) + 2);
1608
1609         offset = __msa_pckev_b((v16i8) offset_mask1, (v16i8) offset_mask0);
1610         dst0 = __msa_pckev_b((v16i8) src_zero1, (v16i8) src_zero0);
1611
1612         VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset, offset,
1613                    offset, offset);
1614
1615         dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1616         dst0 = __msa_adds_s_b(dst0, offset);
1617         dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1618
1619         src_minus10 = src10;
1620         src_minus11 = src11;
1621
1622         /* load in advance */
1623         LD_UB2(src + src_stride, src_stride, src10, src11);
1624
1625         dst_val0 = __msa_copy_u_w((v4i32) dst0, 0);
1626         dst_val1 = __msa_copy_u_w((v4i32) dst0, 2);
1627         SW(dst_val0, dst);
1628         dst += dst_stride;
1629         SW(dst_val1, dst);
1630
1631         dst += dst_stride;
1632     }
1633
1634     src_minus10 = (v16u8) __msa_ilvr_b((v16i8) src10, (v16i8) src_minus10);
1635     src_zero0 = __msa_ilvr_b((v16i8) src_minus11, (v16i8) src_minus11);
1636     src_minus11 = (v16u8) __msa_ilvr_b((v16i8) src11, (v16i8) src_minus11);
1637     src_zero1 = __msa_ilvr_b((v16i8) src10, (v16i8) src10);
1638
1639     cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
1640     diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1641     cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
1642     diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1643
1644     cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
1645     diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
1646     cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
1647     diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
1648
1649     offset_mask0 = (v8i16) (__msa_hadd_u_h(diff_minus10, diff_minus10) + 2);
1650     offset_mask1 = (v8i16) (__msa_hadd_u_h(diff_minus11, diff_minus11) + 2);
1651
1652     offset = __msa_pckev_b((v16i8) offset_mask1, (v16i8) offset_mask0);
1653     dst0 = __msa_pckev_b((v16i8) src_zero1, (v16i8) src_zero0);
1654
1655     VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset,
1656                offset, offset, offset);
1657
1658     dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1659     dst0 = __msa_adds_s_b(dst0, offset);
1660     dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1661
1662     dst_val0 = __msa_copy_u_w((v4i32) dst0, 0);
1663     dst_val1 = __msa_copy_u_w((v4i32) dst0, 2);
1664     SW(dst_val0, dst);
1665     dst += dst_stride;
1666     SW(dst_val1, dst);
1667 }
1668
1669 static void hevc_sao_edge_filter_90degree_8width_msa(uint8_t *dst,
1670                                                      int32_t dst_stride,
1671                                                      uint8_t *src,
1672                                                      int32_t src_stride,
1673                                                      int16_t *sao_offset_val,
1674                                                      int32_t height)
1675 {
1676     uint64_t dst_val0, dst_val1;
1677     v16i8 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1678     v16u8 const1 = (v16u8) __msa_ldi_b(1);
1679     v16i8 offset, sao_offset = LD_SB(sao_offset_val);
1680     v16i8 src_zero0, src_zero1, dst0;
1681     v16u8 cmp_minus10, diff_minus10, cmp_minus11, diff_minus11;
1682     v16u8 src_minus10, src_minus11, src10, src11;
1683     v8i16 offset_mask0, offset_mask1;
1684
1685     sao_offset = __msa_pckev_b(sao_offset, sao_offset);
1686
1687     /* load in advance */
1688     LD_UB2(src - src_stride, src_stride, src_minus10, src_minus11);
1689     LD_UB2(src + src_stride, src_stride, src10, src11);
1690
1691     for (height -= 2; height; height -= 2) {
1692         src += (src_stride << 1);
1693
1694         src_minus10 = (v16u8) __msa_ilvr_b((v16i8) src10, (v16i8) src_minus10);
1695         src_zero0 = __msa_ilvr_b((v16i8) src_minus11, (v16i8) src_minus11);
1696         src_minus11 = (v16u8) __msa_ilvr_b((v16i8) src11, (v16i8) src_minus11);
1697         src_zero1 = __msa_ilvr_b((v16i8) src10, (v16i8) src10);
1698
1699         cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
1700         diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1701         cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
1702         diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1703
1704         cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
1705         diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
1706         cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
1707         diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
1708
1709         offset_mask0 = (v8i16) (__msa_hadd_u_h(diff_minus10, diff_minus10) + 2);
1710         offset_mask1 = (v8i16) (__msa_hadd_u_h(diff_minus11, diff_minus11) + 2);
1711
1712         offset = __msa_pckev_b((v16i8) offset_mask1, (v16i8) offset_mask0);
1713         dst0 = __msa_pckev_b((v16i8) src_zero1, (v16i8) src_zero0);
1714
1715         VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset,
1716                    offset, offset, offset);
1717
1718         dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1719         dst0 = __msa_adds_s_b(dst0, offset);
1720         dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1721
1722         src_minus10 = src10;
1723         src_minus11 = src11;
1724
1725         /* load in advance */
1726         LD_UB2(src + src_stride, src_stride, src10, src11);
1727
1728         dst_val0 = __msa_copy_u_d((v2i64) dst0, 0);
1729         dst_val1 = __msa_copy_u_d((v2i64) dst0, 1);
1730         SD(dst_val0, dst);
1731         dst += dst_stride;
1732         SD(dst_val1, dst);
1733         dst += dst_stride;
1734     }
1735
1736     src_minus10 = (v16u8) __msa_ilvr_b((v16i8) src10, (v16i8) src_minus10);
1737     src_zero0 = __msa_ilvr_b((v16i8) src_minus11, (v16i8) src_minus11);
1738     src_minus11 = (v16u8) __msa_ilvr_b((v16i8) src11, (v16i8) src_minus11);
1739     src_zero1 = __msa_ilvr_b((v16i8) src10, (v16i8) src10);
1740
1741     cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
1742     diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1743     cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
1744     diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1745
1746     cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
1747     diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
1748     cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
1749     diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
1750
1751     offset_mask0 = (v8i16) (__msa_hadd_u_h(diff_minus10, diff_minus10) + 2);
1752     offset_mask1 = (v8i16) (__msa_hadd_u_h(diff_minus11, diff_minus11) + 2);
1753
1754     offset = __msa_pckev_b((v16i8) offset_mask1, (v16i8) offset_mask0);
1755     dst0 = __msa_pckev_b((v16i8) src_zero1, (v16i8) src_zero0);
1756
1757     VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset, offset,
1758                offset, offset);
1759
1760     dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1761     dst0 = __msa_adds_s_b(dst0, offset);
1762     dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1763
1764     dst_val0 = __msa_copy_u_d((v2i64) dst0, 0);
1765     dst_val1 = __msa_copy_u_d((v2i64) dst0, 1);
1766     SD(dst_val0, dst);
1767     dst += dst_stride;
1768     SD(dst_val1, dst);
1769 }
1770
1771 static void hevc_sao_edge_filter_90degree_16multiple_msa(uint8_t *dst,
1772                                                          int32_t dst_stride,
1773                                                          uint8_t *src,
1774                                                          int32_t src_stride,
1775                                                          int16_t *
1776                                                          sao_offset_val,
1777                                                          int32_t width,
1778                                                          int32_t height)
1779 {
1780     uint8_t *src_orig = src;
1781     uint8_t *dst_orig = dst;
1782     int32_t h_cnt, v_cnt;
1783     v16i8 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1784     v16u8 const1 = (v16u8) __msa_ldi_b(1);
1785     v16u8 cmp_minus10, cmp_plus10, diff_minus10, diff_plus10, cmp_minus11;
1786     v16u8 cmp_plus11, diff_minus11, diff_plus11, cmp_minus12, cmp_plus12;
1787     v16u8 diff_minus12, diff_plus12, cmp_minus13, cmp_plus13, diff_minus13;
1788     v16u8 diff_plus13;
1789     v16u8 src10, src_minus10, dst0, src11, src_minus11, dst1;
1790     v16u8 src12, dst2, src13, dst3;
1791     v16i8 offset_mask0, offset_mask1, offset_mask2, offset_mask3, sao_offset;
1792
1793     sao_offset = LD_SB(sao_offset_val);
1794     sao_offset = __msa_pckev_b(sao_offset, sao_offset);
1795
1796     for (v_cnt = 0; v_cnt < width; v_cnt += 16) {
1797         src = src_orig + v_cnt;
1798         dst = dst_orig + v_cnt;
1799
1800         LD_UB2(src - src_stride, src_stride, src_minus10, src_minus11);
1801
1802         for (h_cnt = (height >> 2); h_cnt--;) {
1803             LD_UB4(src + src_stride, src_stride, src10, src11, src12, src13);
1804
1805             cmp_minus10 = (src_minus11 == src_minus10);
1806             cmp_plus10 = (src_minus11 == src10);
1807             cmp_minus11 = (src10 == src_minus11);
1808             cmp_plus11 = (src10 == src11);
1809             cmp_minus12 = (src11 == src10);
1810             cmp_plus12 = (src11 == src12);
1811             cmp_minus13 = (src12 == src11);
1812             cmp_plus13 = (src12 == src13);
1813
1814             diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1815             diff_plus10 = __msa_nor_v(cmp_plus10, cmp_plus10);
1816             diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
1817             diff_plus11 = __msa_nor_v(cmp_plus11, cmp_plus11);
1818             diff_minus12 = __msa_nor_v(cmp_minus12, cmp_minus12);
1819             diff_plus12 = __msa_nor_v(cmp_plus12, cmp_plus12);
1820             diff_minus13 = __msa_nor_v(cmp_minus13, cmp_minus13);
1821             diff_plus13 = __msa_nor_v(cmp_plus13, cmp_plus13);
1822
1823             cmp_minus10 = (src_minus10 < src_minus11);
1824             cmp_plus10 = (src10 < src_minus11);
1825             cmp_minus11 = (src_minus11 < src10);
1826             cmp_plus11 = (src11 < src10);
1827             cmp_minus12 = (src10 < src11);
1828             cmp_plus12 = (src12 < src11);
1829             cmp_minus13 = (src11 < src12);
1830             cmp_plus13 = (src13 < src12);
1831
1832             diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1833             diff_plus10 = __msa_bmnz_v(diff_plus10, const1, cmp_plus10);
1834             diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
1835             diff_plus11 = __msa_bmnz_v(diff_plus11, const1, cmp_plus11);
1836             diff_minus12 = __msa_bmnz_v(diff_minus12, const1, cmp_minus12);
1837             diff_plus12 = __msa_bmnz_v(diff_plus12, const1, cmp_plus12);
1838             diff_minus13 = __msa_bmnz_v(diff_minus13, const1, cmp_minus13);
1839             diff_plus13 = __msa_bmnz_v(diff_plus13, const1, cmp_plus13);
1840
1841             offset_mask0 = 2 + (v16i8) diff_minus10 + (v16i8) diff_plus10;
1842             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
1843                        offset_mask0, offset_mask0, offset_mask0, offset_mask0);
1844             offset_mask1 = 2 + (v16i8) diff_minus11 + (v16i8) diff_plus11;
1845             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
1846                        offset_mask1, offset_mask1, offset_mask1, offset_mask1);
1847             offset_mask2 = 2 + (v16i8) diff_minus12 + (v16i8) diff_plus12;
1848             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
1849                        offset_mask2, offset_mask2, offset_mask2, offset_mask2);
1850             offset_mask3 = 2 + (v16i8) diff_minus13 + (v16i8) diff_plus13;
1851             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
1852                        offset_mask3, offset_mask3, offset_mask3, offset_mask3);
1853
1854             src_minus10 = src12;
1855             XORI_B4_128_UB(src_minus11, src10, src11, src12);
1856
1857             dst0 = (v16u8) __msa_adds_s_b((v16i8) src_minus11, offset_mask0);
1858             dst1 = (v16u8) __msa_adds_s_b((v16i8) src10, offset_mask1);
1859             dst2 = (v16u8) __msa_adds_s_b((v16i8) src11, offset_mask2);
1860             dst3 = (v16u8) __msa_adds_s_b((v16i8) src12, offset_mask3);
1861
1862             XORI_B4_128_UB(dst0, dst1, dst2, dst3);
1863             src_minus11 = src13;
1864
1865             ST_UB4(dst0, dst1, dst2, dst3, dst, dst_stride);
1866
1867             src += (src_stride << 2);
1868             dst += (dst_stride << 2);
1869         }
1870     }
1871 }
1872
1873 static void hevc_sao_edge_filter_45degree_4width_msa(uint8_t *dst,
1874                                                      int32_t dst_stride,
1875                                                      uint8_t *src,
1876                                                      int32_t src_stride,
1877                                                      int16_t *sao_offset_val,
1878                                                      int32_t height)
1879 {
1880     uint8_t *src_orig;
1881     uint32_t dst_val0, dst_val1;
1882     v16i8 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1883     v16u8 const1 = (v16u8) __msa_ldi_b(1);
1884     v16i8 offset, sao_offset = LD_SB(sao_offset_val);
1885     v16u8 cmp_minus10, diff_minus10, src_minus10, cmp_minus11, diff_minus11;
1886     v16u8 src_minus11, src10, src11;
1887     v16i8 src_plus0, src_zero0, src_plus1, src_zero1, dst0;
1888     v8i16 offset_mask0, offset_mask1;
1889
1890     sao_offset = __msa_pckev_b(sao_offset, sao_offset);
1891
1892     src_orig = src - 1;
1893
1894     /* load in advance */
1895     LD_UB2(src_orig - src_stride, src_stride, src_minus10, src_minus11);
1896     LD_UB2(src_orig + src_stride, src_stride, src10, src11);
1897
1898     for (height -= 2; height; height -= 2) {
1899         src_orig += (src_stride << 1);
1900
1901         SLDI_B2_0_SB(src_minus11, src10, src_zero0, src_zero1, 1);
1902         SLDI_B2_0_SB(src10, src11, src_plus0, src_plus1, 2);
1903
1904         ILVR_B2_UB(src_plus0, src_minus10, src_plus1, src_minus11, src_minus10,
1905                    src_minus11);
1906         ILVR_B2_SB(src_zero0, src_zero0, src_zero1, src_zero1, src_zero0,
1907                    src_zero1);
1908
1909         cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
1910         diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1911         cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
1912         diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1913
1914         cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
1915         diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
1916         cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
1917         diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
1918
1919         offset_mask0 = (v8i16) (__msa_hadd_u_h(diff_minus10, diff_minus10) + 2);
1920         offset_mask1 = (v8i16) (__msa_hadd_u_h(diff_minus11, diff_minus11) + 2);
1921
1922         offset = __msa_pckev_b((v16i8) offset_mask1, (v16i8) offset_mask0);
1923         dst0 = __msa_pckev_b((v16i8) src_zero1, (v16i8) src_zero0);
1924
1925         VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset,
1926                    offset, offset, offset);
1927
1928         dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1929         dst0 = __msa_adds_s_b(dst0, offset);
1930         dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1931
1932         src_minus10 = src10;
1933         src_minus11 = src11;
1934
1935         /* load in advance */
1936         LD_UB2(src_orig + src_stride, src_stride, src10, src11);
1937
1938         dst_val0 = __msa_copy_u_w((v4i32) dst0, 0);
1939         dst_val1 = __msa_copy_u_w((v4i32) dst0, 2);
1940         SW(dst_val0, dst);
1941         dst += dst_stride;
1942         SW(dst_val1, dst);
1943
1944         dst += dst_stride;
1945     }
1946
1947     SLDI_B2_0_SB(src_minus11, src10, src_zero0, src_zero1, 1);
1948     SLDI_B2_0_SB(src10, src11, src_plus0, src_plus1, 2);
1949
1950     ILVR_B2_UB(src_plus0, src_minus10, src_plus1, src_minus11, src_minus10,
1951                src_minus11);
1952     ILVR_B2_SB(src_zero0, src_zero0, src_zero1, src_zero1, src_zero0,
1953                src_zero1);
1954
1955     cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
1956     diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
1957     cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
1958     diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
1959
1960     cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
1961     diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
1962     cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
1963     diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
1964
1965     offset_mask0 = (v8i16) (__msa_hadd_u_h(diff_minus10, diff_minus10) + 2);
1966     offset_mask1 = (v8i16) (__msa_hadd_u_h(diff_minus11, diff_minus11) + 2);
1967
1968     offset = __msa_pckev_b((v16i8) offset_mask1, (v16i8) offset_mask0);
1969     dst0 = __msa_pckev_b((v16i8) src_zero1, (v16i8) src_zero0);
1970
1971     VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset, offset,
1972                offset, offset);
1973
1974     dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1975     dst0 = __msa_adds_s_b(dst0, offset);
1976     dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
1977
1978     dst_val0 = __msa_copy_u_w((v4i32) dst0, 0);
1979     dst_val1 = __msa_copy_u_w((v4i32) dst0, 2);
1980     SW(dst_val0, dst);
1981     dst += dst_stride;
1982     SW(dst_val1, dst);
1983 }
1984
1985 static void hevc_sao_edge_filter_45degree_8width_msa(uint8_t *dst,
1986                                                      int32_t dst_stride,
1987                                                      uint8_t *src,
1988                                                      int32_t src_stride,
1989                                                      int16_t *sao_offset_val,
1990                                                      int32_t height)
1991 {
1992     uint8_t *src_orig;
1993     uint64_t dst_val0, dst_val1;
1994     v16i8 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
1995     v16u8 const1 = (v16u8) __msa_ldi_b(1);
1996     v16i8 offset, sao_offset = LD_SB(sao_offset_val);
1997     v16u8 cmp_minus10, diff_minus10, cmp_minus11, diff_minus11;
1998     v16u8 src_minus10, src10, src_minus11, src11;
1999     v16i8 src_zero0, src_plus10, src_zero1, src_plus11, dst0;
2000     v8i16 offset_mask0, offset_mask1;
2001
2002     sao_offset = __msa_pckev_b(sao_offset, sao_offset);
2003     src_orig = src - 1;
2004
2005     /* load in advance */
2006     LD_UB2(src_orig - src_stride, src_stride, src_minus10, src_minus11);
2007     LD_UB2(src_orig + src_stride, src_stride, src10, src11);
2008
2009     for (height -= 2; height; height -= 2) {
2010         src_orig += (src_stride << 1);
2011
2012         SLDI_B2_0_SB(src_minus11, src10, src_zero0, src_zero1, 1);
2013         SLDI_B2_0_SB(src10, src11, src_plus10, src_plus11, 2);
2014
2015         ILVR_B2_UB(src_plus10, src_minus10, src_plus11, src_minus11,
2016                    src_minus10, src_minus11);
2017         ILVR_B2_SB(src_zero0, src_zero0, src_zero1, src_zero1,
2018                    src_zero0, src_zero1);
2019
2020         cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
2021         diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
2022         cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
2023         diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
2024
2025         cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
2026         diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
2027         cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
2028         diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
2029
2030         offset_mask0 = (v8i16) (__msa_hadd_u_h(diff_minus10, diff_minus10) + 2);
2031         offset_mask1 = (v8i16) (__msa_hadd_u_h(diff_minus11, diff_minus11) + 2);
2032
2033         offset = __msa_pckev_b((v16i8) offset_mask1, (v16i8) offset_mask0);
2034         dst0 = __msa_pckev_b((v16i8) src_zero1, (v16i8) src_zero0);
2035
2036         VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset, offset,
2037                    offset, offset);
2038
2039         dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
2040         dst0 = __msa_adds_s_b(dst0, offset);
2041         dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
2042
2043         src_minus10 = src10;
2044         src_minus11 = src11;
2045
2046         /* load in advance */
2047         LD_UB2(src_orig + src_stride, src_stride, src10, src11);
2048
2049         dst_val0 = __msa_copy_u_d((v2i64) dst0, 0);
2050         dst_val1 = __msa_copy_u_d((v2i64) dst0, 1);
2051         SD(dst_val0, dst);
2052         dst += dst_stride;
2053         SD(dst_val1, dst);
2054         dst += dst_stride;
2055     }
2056
2057     SLDI_B2_0_SB(src_minus11, src10, src_zero0, src_zero1, 1);
2058     SLDI_B2_0_SB(src10, src11, src_plus10, src_plus11, 2);
2059     ILVR_B2_UB(src_plus10, src_minus10, src_plus11, src_minus11, src_minus10,
2060                src_minus11);
2061     ILVR_B2_SB(src_zero0, src_zero0, src_zero1, src_zero1, src_zero0,
2062                src_zero1);
2063
2064     cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
2065     diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
2066     cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
2067     diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
2068
2069     cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
2070     diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
2071     cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
2072     diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
2073
2074     offset_mask0 = (v8i16) (__msa_hadd_u_h(diff_minus10, diff_minus10) + 2);
2075     offset_mask1 = (v8i16) (__msa_hadd_u_h(diff_minus11, diff_minus11) + 2);
2076
2077     offset = __msa_pckev_b((v16i8) offset_mask1, (v16i8) offset_mask0);
2078     dst0 = __msa_pckev_b((v16i8) src_zero1, (v16i8) src_zero0);
2079
2080     VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset, offset, offset,
2081                offset, offset);
2082
2083     dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
2084     dst0 = __msa_adds_s_b(dst0, offset);
2085     dst0 = (v16i8) __msa_xori_b((v16u8) dst0, 128);
2086
2087     src_minus10 = src10;
2088     src_minus11 = src11;
2089
2090     /* load in advance */
2091     LD_UB2(src_orig + src_stride, src_stride, src10, src11);
2092
2093     dst_val0 = __msa_copy_u_d((v2i64) dst0, 0);
2094     dst_val1 = __msa_copy_u_d((v2i64) dst0, 1);
2095     SD(dst_val0, dst);
2096     dst += dst_stride;
2097     SD(dst_val1, dst);
2098 }
2099
2100 static void hevc_sao_edge_filter_45degree_16multiple_msa(uint8_t *dst,
2101                                                          int32_t dst_stride,
2102                                                          uint8_t *src,
2103                                                          int32_t src_stride,
2104                                                          int16_t *
2105                                                          sao_offset_val,
2106                                                          int32_t width,
2107                                                          int32_t height)
2108 {
2109     uint8_t *src_orig = src;
2110     uint8_t *dst_orig = dst;
2111     int32_t v_cnt;
2112     v16i8 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
2113     v16u8 const1 = (v16u8) __msa_ldi_b(1);
2114     v16u8 cmp_minus10, cmp_plus10, diff_minus10, diff_plus10, cmp_minus11;
2115     v16u8 cmp_plus11, diff_minus11, diff_plus11, cmp_minus12, cmp_plus12;
2116     v16u8 diff_minus12, diff_plus12, cmp_minus13, cmp_plus13, diff_minus13;
2117     v16u8 diff_plus13, src_minus14, src_plus13;
2118     v16i8 offset_mask0, offset_mask1, offset_mask2, offset_mask3;
2119     v16u8 src10, src_minus10, dst0, src11, src_minus11, dst1;
2120     v16u8 src12, src_minus12, dst2, src13, src_minus13, dst3;
2121     v16i8 src_zero0, src_plus10, src_zero1, src_plus11, src_zero2, src_plus12;
2122     v16i8 src_zero3, sao_offset;
2123
2124     sao_offset = LD_SB(sao_offset_val);
2125     sao_offset = __msa_pckev_b(sao_offset, sao_offset);
2126
2127     for (; height; height -= 4) {
2128         src_orig = src - 1;
2129         dst_orig = dst;
2130         LD_UB4(src_orig, src_stride, src_minus11, src_minus12, src_minus13,
2131                src_minus14);
2132
2133         for (v_cnt = 0; v_cnt < width; v_cnt += 16) {
2134             src_minus10 = LD_UB(src_orig - src_stride);
2135             LD_UB4(src_orig + 16, src_stride, src10, src11, src12, src13);
2136             src_plus13 = LD_UB(src + 1 + v_cnt + (src_stride << 2));
2137             src_orig += 16;
2138
2139             SLDI_B2_SB(src10, src11, src_minus11, src_minus12, src_zero0,
2140                        src_zero1, 1);
2141             SLDI_B2_SB(src12, src13, src_minus13, src_minus14, src_zero2,
2142                        src_zero3, 1);
2143             SLDI_B2_SB(src11, src12, src_minus12, src_minus13, src_plus10,
2144                        src_plus11, 2);
2145
2146             src_plus12 = __msa_sldi_b((v16i8) src13, (v16i8) src_minus14, 2);
2147
2148             cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
2149             cmp_plus10 = ((v16u8) src_zero0 == (v16u8) src_plus10);
2150             cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
2151             cmp_plus11 = ((v16u8) src_zero1 == (v16u8) src_plus11);
2152             cmp_minus12 = ((v16u8) src_zero2 == src_minus12);
2153             cmp_plus12 = ((v16u8) src_zero2 == (v16u8) src_plus12);
2154             cmp_minus13 = ((v16u8) src_zero3 == src_minus13);
2155             cmp_plus13 = ((v16u8) src_zero3 == src_plus13);
2156
2157             diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
2158             diff_plus10 = __msa_nor_v(cmp_plus10, cmp_plus10);
2159             diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
2160             diff_plus11 = __msa_nor_v(cmp_plus11, cmp_plus11);
2161             diff_minus12 = __msa_nor_v(cmp_minus12, cmp_minus12);
2162             diff_plus12 = __msa_nor_v(cmp_plus12, cmp_plus12);
2163             diff_minus13 = __msa_nor_v(cmp_minus13, cmp_minus13);
2164             diff_plus13 = __msa_nor_v(cmp_plus13, cmp_plus13);
2165
2166             cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
2167             cmp_plus10 = ((v16u8) src_plus10 < (v16u8) src_zero0);
2168             cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
2169             cmp_plus11 = ((v16u8) src_plus11 < (v16u8) src_zero1);
2170             cmp_minus12 = (src_minus12 < (v16u8) src_zero2);
2171             cmp_plus12 = ((v16u8) src_plus12 < (v16u8) src_zero2);
2172             cmp_minus13 = (src_minus13 < (v16u8) src_zero3);
2173             cmp_plus13 = (src_plus13 < (v16u8) src_zero3);
2174
2175             diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
2176             diff_plus10 = __msa_bmnz_v(diff_plus10, const1, cmp_plus10);
2177             diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
2178             diff_plus11 = __msa_bmnz_v(diff_plus11, const1, cmp_plus11);
2179             diff_minus12 = __msa_bmnz_v(diff_minus12, const1, cmp_minus12);
2180             diff_plus12 = __msa_bmnz_v(diff_plus12, const1, cmp_plus12);
2181             diff_minus13 = __msa_bmnz_v(diff_minus13, const1, cmp_minus13);
2182             diff_plus13 = __msa_bmnz_v(diff_plus13, const1, cmp_plus13);
2183
2184             offset_mask0 = 2 + (v16i8) diff_minus10 + (v16i8) diff_plus10;
2185             offset_mask1 = 2 + (v16i8) diff_minus11 + (v16i8) diff_plus11;
2186             offset_mask2 = 2 + (v16i8) diff_minus12 + (v16i8) diff_plus12;
2187             offset_mask3 = 2 + (v16i8) diff_minus13 + (v16i8) diff_plus13;
2188
2189             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
2190                        offset_mask0, offset_mask0, offset_mask0, offset_mask0);
2191             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
2192                        offset_mask1, offset_mask1, offset_mask1, offset_mask1);
2193             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
2194                        offset_mask2, offset_mask2, offset_mask2, offset_mask2);
2195             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
2196                        offset_mask3, offset_mask3, offset_mask3, offset_mask3);
2197
2198             XORI_B4_128_SB(src_zero0, src_zero1, src_zero2, src_zero3);
2199
2200             dst0 = (v16u8) __msa_adds_s_b((v16i8) src_zero0, offset_mask0);
2201             dst1 = (v16u8) __msa_adds_s_b((v16i8) src_zero1, offset_mask1);
2202             dst2 = (v16u8) __msa_adds_s_b((v16i8) src_zero2, offset_mask2);
2203             dst3 = (v16u8) __msa_adds_s_b((v16i8) src_zero3, offset_mask3);
2204
2205             XORI_B4_128_UB(dst0, dst1, dst2, dst3);
2206
2207             src_minus11 = src10;
2208             src_minus12 = src11;
2209             src_minus13 = src12;
2210             src_minus14 = src13;
2211
2212             ST_UB4(dst0, dst1, dst2, dst3, dst_orig, dst_stride);
2213             dst_orig += 16;
2214         }
2215
2216         src += (src_stride << 2);
2217         dst += (dst_stride << 2);
2218     }
2219 }
2220
2221 static void hevc_sao_edge_filter_135degree_4width_msa(uint8_t *dst,
2222                                                       int32_t dst_stride,
2223                                                       uint8_t *src,
2224                                                       int32_t src_stride,
2225                                                       int16_t *sao_offset_val,
2226                                                       int32_t height)
2227 {
2228     uint8_t *src_orig;
2229     int32_t h_cnt;
2230     uint32_t dst_val0, dst_val1;
2231     v8i16 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0 };
2232     v16u8 const1 = (v16u8) __msa_ldi_b(1);
2233     v16i8 zero = { 0 };
2234     v16i8 src_zero0, src_zero1, dst0;
2235     v16u8 cmp_minus10, diff_minus10, cmp_minus11, diff_minus11;
2236     v16u8 src_minus10, src10, src_minus11, src11;
2237     v8i16 offset_mask0, offset_mask1, sao_offset, src00, src01;
2238
2239     sao_offset = LD_SH(sao_offset_val);
2240     src_orig = src - 1;
2241
2242     LD_UB2(src_orig - src_stride, src_stride, src_minus10, src_minus11);
2243
2244     for (h_cnt = (height >> 1); h_cnt--;) {
2245         LD_UB2(src_orig + src_stride, src_stride, src10, src11);
2246
2247         SLDI_B2_0_SB(src_minus11, src10, src_zero0, src_zero1, 1);
2248         SLDI_B2_0_UB(src_minus10, src_minus11, src_minus10, src_minus11, 2);
2249
2250         ILVR_B2_UB(src10, src_minus10, src11, src_minus11, src_minus10,
2251                    src_minus11);
2252         ILVR_B2_SB(src_zero0, src_zero0, src_zero1, src_zero1, src_zero0,
2253                    src_zero1);
2254
2255         cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
2256         diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
2257         cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
2258         diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
2259
2260         cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
2261         diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
2262         cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
2263         diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
2264
2265         offset_mask0 = (v8i16) (__msa_hadd_u_h(diff_minus10, diff_minus10) + 2);
2266         offset_mask1 = (v8i16) (__msa_hadd_u_h(diff_minus11, diff_minus11) + 2);
2267
2268         VSHF_H2_SH(edge_idx, edge_idx, sao_offset, sao_offset, offset_mask0,
2269                    offset_mask0, offset_mask0, offset_mask0);
2270         VSHF_H2_SH(edge_idx, edge_idx, sao_offset, sao_offset, offset_mask1,
2271                    offset_mask1, offset_mask1, offset_mask1);
2272         ILVEV_B2_SH(src_zero0, zero, src_zero1, zero, src00, src01);
2273         ADD2(offset_mask0, src00, offset_mask1, src01, offset_mask0,
2274              offset_mask1);
2275         CLIP_SH2_0_255(offset_mask0, offset_mask1);
2276         dst0 = __msa_pckev_b((v16i8) offset_mask1, (v16i8) offset_mask0);
2277
2278         src_minus10 = src10;
2279         src_minus11 = src11;
2280
2281         dst_val0 = __msa_copy_u_w((v4i32) dst0, 0);
2282         dst_val1 = __msa_copy_u_w((v4i32) dst0, 2);
2283
2284         SW(dst_val0, dst);
2285         dst += dst_stride;
2286         SW(dst_val1, dst);
2287
2288         dst += dst_stride;
2289         src_orig += (src_stride << 1);
2290     }
2291 }
2292
2293 static void hevc_sao_edge_filter_135degree_8width_msa(uint8_t *dst,
2294                                                       int32_t dst_stride,
2295                                                       uint8_t *src,
2296                                                       int32_t src_stride,
2297                                                       int16_t *sao_offset_val,
2298                                                       int32_t height)
2299 {
2300     uint8_t *src_orig;
2301     int32_t h_cnt;
2302     uint64_t dst_val0, dst_val1;
2303     v8i16 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0 };
2304     v16u8 const1 = (v16u8) __msa_ldi_b(1);
2305     v16i8 zero = { 0 };
2306     v16i8 src_zero0, src_zero1, dst0, dst1;
2307     v16u8 cmp_minus10, diff_minus10, cmp_minus11, diff_minus11;
2308     v16u8 src_minus10, src10, src_minus11, src11;
2309     v8i16 sao_offset, src00, offset_mask0, src01, offset_mask1;
2310
2311     sao_offset = LD_SH(sao_offset_val);
2312     src_orig = src - 1;
2313
2314     LD_UB2(src_orig - src_stride, src_stride, src_minus10, src_minus11);
2315
2316     for (h_cnt = (height >> 1); h_cnt--;) {
2317         LD_UB2(src_orig + src_stride, src_stride, src10, src11);
2318
2319         SLDI_B2_0_SB(src_minus11, src10, src_zero0, src_zero1, 1);
2320         SLDI_B2_0_UB(src_minus10, src_minus11, src_minus10, src_minus11, 2);
2321         ILVR_B2_UB(src10, src_minus10, src11, src_minus11, src_minus10,
2322                    src_minus11);
2323         ILVR_B2_SB(src_zero0, src_zero0, src_zero1, src_zero1, src_zero0,
2324                    src_zero1);
2325
2326         cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
2327         diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
2328         cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
2329         diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
2330
2331         cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
2332         diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
2333         cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
2334         diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
2335
2336         offset_mask0 = (v8i16) (__msa_hadd_u_h(diff_minus10, diff_minus10) + 2);
2337         offset_mask1 = (v8i16) (__msa_hadd_u_h(diff_minus11, diff_minus11) + 2);
2338
2339         VSHF_H2_SH(edge_idx, edge_idx, sao_offset, sao_offset, offset_mask0,
2340                    offset_mask0, offset_mask0, offset_mask0);
2341         VSHF_H2_SH(edge_idx, edge_idx, sao_offset, sao_offset, offset_mask1,
2342                    offset_mask1, offset_mask1, offset_mask1);
2343         ILVEV_B2_SH(src_zero0, zero, src_zero1, zero, src00, src01);
2344         ADD2(offset_mask0, src00, offset_mask1, src01, offset_mask0,
2345              offset_mask1);
2346         CLIP_SH2_0_255(offset_mask0, offset_mask1);
2347         PCKEV_B2_SB(offset_mask0, offset_mask0, offset_mask1, offset_mask1,
2348                     dst0, dst1);
2349
2350         src_minus10 = src10;
2351         src_minus11 = src11;
2352
2353         dst_val0 = __msa_copy_u_d((v2i64) dst0, 0);
2354         dst_val1 = __msa_copy_u_d((v2i64) dst1, 0);
2355
2356         SD(dst_val0, dst);
2357         dst += dst_stride;
2358         SD(dst_val1, dst);
2359         dst += dst_stride;
2360
2361         src_orig += (src_stride << 1);
2362     }
2363 }
2364
2365 static void hevc_sao_edge_filter_135degree_16multiple_msa(uint8_t *dst,
2366                                                           int32_t dst_stride,
2367                                                           uint8_t *src,
2368                                                           int32_t src_stride,
2369                                                           int16_t *
2370                                                           sao_offset_val,
2371                                                           int32_t width,
2372                                                           int32_t height)
2373 {
2374     uint8_t *src_orig, *dst_orig;
2375     int32_t h_cnt, v_cnt;
2376     v16i8 edge_idx = { 1, 2, 0, 3, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
2377     v16u8 const1 = (v16u8) __msa_ldi_b(1);
2378     v16u8 dst0, dst1, dst2, dst3;
2379     v16u8 cmp_minus10, cmp_minus11, cmp_minus12, cmp_minus13, cmp_plus10;
2380     v16u8 cmp_plus11, cmp_plus12, cmp_plus13, diff_minus10, diff_minus11;
2381     v16u8 diff_minus12, diff_minus13, diff_plus10, diff_plus11, diff_plus12;
2382     v16u8 diff_plus13, src10, src11, src12, src13, src_minus10, src_minus11;
2383     v16u8 src_plus10, src_plus11, src_plus12, src_plus13;
2384     v16i8 src_minus12, src_minus13, src_zero0, src_zero1, src_zero2, src_zero3;
2385     v16i8 offset_mask0, offset_mask1, offset_mask2, offset_mask3, sao_offset;
2386     v8i16 src0, src1, src2, src3, src4, src5, src6, src7;
2387     v8i16 temp0, temp1, temp2, temp3, temp4, temp5, temp6, temp7;
2388
2389     sao_offset = LD_SB(sao_offset_val);
2390     sao_offset = __msa_pckev_b(sao_offset, sao_offset);
2391
2392     for (h_cnt = (height >> 2); h_cnt--;) {
2393         src_orig = src - 1;
2394         dst_orig = dst;
2395
2396         LD_UB4(src_orig, src_stride,
2397                src_minus11, src_plus10, src_plus11, src_plus12);
2398
2399         for (v_cnt = 0; v_cnt < (width >> 4); v_cnt++) {
2400             src_minus10 = LD_UB(src_orig + 2 - src_stride);
2401             LD_UB4(src_orig + 16, src_stride, src10, src11, src12, src13);
2402             src_plus13 = LD_UB(src_orig + (src_stride << 2));
2403             src_orig += 16;
2404
2405             src_zero0 = __msa_sldi_b((v16i8) src10, (v16i8) src_minus11, 1);
2406             cmp_minus10 = ((v16u8) src_zero0 == src_minus10);
2407             cmp_plus10 = ((v16u8) src_zero0 == src_plus10);
2408
2409             src_zero1 = __msa_sldi_b((v16i8) src11, (v16i8) src_plus10, 1);
2410             src_minus11 = (v16u8) __msa_sldi_b((v16i8) src10,
2411                                                (v16i8) src_minus11, 2);
2412             cmp_minus11 = ((v16u8) src_zero1 == src_minus11);
2413             cmp_plus11 = ((v16u8) src_zero1 == src_plus11);
2414
2415             src_zero2 = __msa_sldi_b((v16i8) src12, (v16i8) src_plus11, 1);
2416             src_minus12 = __msa_sldi_b((v16i8) src11, (v16i8) src_plus10, 2);
2417             cmp_minus12 = ((v16u8) src_zero2 == (v16u8) src_minus12);
2418             cmp_plus12 = ((v16u8) src_zero2 == src_plus12);
2419
2420             src_zero3 = __msa_sldi_b((v16i8) src13, (v16i8) src_plus12, 1);
2421             src_minus13 = __msa_sldi_b((v16i8) src12, (v16i8) src_plus11, 2);
2422             cmp_minus13 = ((v16u8) src_zero3 == (v16u8) src_minus13);
2423             cmp_plus13 = ((v16u8) src_zero3 == src_plus13);
2424
2425             diff_minus10 = __msa_nor_v(cmp_minus10, cmp_minus10);
2426             diff_plus10 = __msa_nor_v(cmp_plus10, cmp_plus10);
2427             diff_minus11 = __msa_nor_v(cmp_minus11, cmp_minus11);
2428             diff_plus11 = __msa_nor_v(cmp_plus11, cmp_plus11);
2429             diff_minus12 = __msa_nor_v(cmp_minus12, cmp_minus12);
2430             diff_plus12 = __msa_nor_v(cmp_plus12, cmp_plus12);
2431             diff_minus13 = __msa_nor_v(cmp_minus13, cmp_minus13);
2432             diff_plus13 = __msa_nor_v(cmp_plus13, cmp_plus13);
2433
2434             cmp_minus10 = (src_minus10 < (v16u8) src_zero0);
2435             cmp_plus10 = (src_plus10 < (v16u8) src_zero0);
2436             cmp_minus11 = (src_minus11 < (v16u8) src_zero1);
2437             cmp_plus11 = (src_plus11 < (v16u8) src_zero1);
2438             cmp_minus12 = ((v16u8) src_minus12 < (v16u8) src_zero2);
2439             cmp_plus12 = (src_plus12 < (v16u8) src_zero2);
2440             cmp_minus13 = ((v16u8) src_minus13 < (v16u8) src_zero3);
2441             cmp_plus13 = (src_plus13 < (v16u8) src_zero3);
2442
2443             diff_minus10 = __msa_bmnz_v(diff_minus10, const1, cmp_minus10);
2444             diff_plus10 = __msa_bmnz_v(diff_plus10, const1, cmp_plus10);
2445             diff_minus11 = __msa_bmnz_v(diff_minus11, const1, cmp_minus11);
2446             diff_plus11 = __msa_bmnz_v(diff_plus11, const1, cmp_plus11);
2447             diff_minus12 = __msa_bmnz_v(diff_minus12, const1, cmp_minus12);
2448             diff_plus12 = __msa_bmnz_v(diff_plus12, const1, cmp_plus12);
2449             diff_minus13 = __msa_bmnz_v(diff_minus13, const1, cmp_minus13);
2450             diff_plus13 = __msa_bmnz_v(diff_plus13, const1, cmp_plus13);
2451
2452             offset_mask0 = 2 + (v16i8) diff_minus10 + (v16i8) diff_plus10;
2453             offset_mask1 = 2 + (v16i8) diff_minus11 + (v16i8) diff_plus11;
2454             offset_mask2 = 2 + (v16i8) diff_minus12 + (v16i8) diff_plus12;
2455             offset_mask3 = 2 + (v16i8) diff_minus13 + (v16i8) diff_plus13;
2456
2457             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
2458                        offset_mask0, offset_mask0, offset_mask0, offset_mask0);
2459             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
2460                        offset_mask1, offset_mask1, offset_mask1, offset_mask1);
2461             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
2462                        offset_mask2, offset_mask2, offset_mask2, offset_mask2);
2463             VSHF_B2_SB(edge_idx, edge_idx, sao_offset, sao_offset,
2464                        offset_mask3, offset_mask3, offset_mask3, offset_mask3);
2465
2466             UNPCK_UB_SH(src_zero0, src0, src1);
2467             UNPCK_SB_SH(offset_mask0, temp0, temp1);
2468             UNPCK_UB_SH(src_zero1, src2, src3);
2469             UNPCK_SB_SH(offset_mask1, temp2, temp3);
2470             UNPCK_UB_SH(src_zero2, src4, src5);
2471             UNPCK_SB_SH(offset_mask2, temp4, temp5);
2472             UNPCK_UB_SH(src_zero3, src6, src7);
2473             UNPCK_SB_SH(offset_mask3, temp6, temp7);
2474
2475             ADD4(temp0, src0, temp1, src1, temp2, src2, temp3, src3, temp0,
2476                  temp1, temp2, temp3);
2477             ADD4(temp4, src4, temp5, src5, temp6, src6, temp7, src7, temp4,
2478                  temp5, temp6, temp7);
2479             CLIP_SH4_0_255(temp0, temp1, temp2, temp3);
2480             CLIP_SH4_0_255(temp4, temp5, temp6, temp7);
2481             PCKEV_B4_UB(temp1, temp0, temp3, temp2, temp5, temp4, temp7, temp6,
2482                         dst0, dst1, dst2, dst3);
2483
2484             src_minus11 = src10;
2485             src_plus10 = src11;
2486             src_plus11 = src12;
2487             src_plus12 = src13;
2488
2489             ST_UB4(dst0, dst1, dst2, dst3, dst_orig, dst_stride);
2490             dst_orig += 16;
2491         }
2492
2493         src += (src_stride << 2);
2494         dst += (dst_stride << 2);
2495     }
2496 }
2497
2498 void ff_hevc_loop_filter_luma_h_8_msa(uint8_t *src,
2499                                       ptrdiff_t src_stride,
2500                                       int32_t beta, int32_t *tc,
2501                                       uint8_t *no_p, uint8_t *no_q)
2502 {
2503     hevc_loopfilter_luma_hor_msa(src, src_stride, beta, tc, no_p, no_q);
2504 }
2505
2506 void ff_hevc_loop_filter_luma_v_8_msa(uint8_t *src,
2507                                       ptrdiff_t src_stride,
2508                                       int32_t beta, int32_t *tc,
2509                                       uint8_t *no_p, uint8_t *no_q)
2510 {
2511     hevc_loopfilter_luma_ver_msa(src, src_stride, beta, tc, no_p, no_q);
2512 }
2513
2514 void ff_hevc_loop_filter_chroma_h_8_msa(uint8_t *src,
2515                                         ptrdiff_t src_stride,
2516                                         int32_t *tc, uint8_t *no_p,
2517                                         uint8_t *no_q)
2518 {
2519     hevc_loopfilter_chroma_hor_msa(src, src_stride, tc, no_p, no_q);
2520 }
2521
2522 void ff_hevc_loop_filter_chroma_v_8_msa(uint8_t *src,
2523                                         ptrdiff_t src_stride,
2524                                         int32_t *tc, uint8_t *no_p,
2525                                         uint8_t *no_q)
2526 {
2527     hevc_loopfilter_chroma_ver_msa(src, src_stride, tc, no_p, no_q);
2528 }
2529
2530 void ff_hevc_sao_band_filter_0_8_msa(uint8_t *dst, uint8_t *src,
2531                                      ptrdiff_t stride_dst, ptrdiff_t stride_src,
2532                                      int16_t *sao_offset_val, int sao_left_class,
2533                                      int width, int height)
2534 {
2535     if (width >> 4) {
2536         hevc_sao_band_filter_16multiple_msa(dst, stride_dst, src, stride_src,
2537                                             sao_left_class, sao_offset_val,
2538                                             width - (width % 16), height);
2539         dst += width - (width % 16);
2540         src += width - (width % 16);
2541         width %= 16;
2542     }
2543
2544     if (width >> 3) {
2545         hevc_sao_band_filter_8width_msa(dst, stride_dst, src, stride_src,
2546                                         sao_left_class, sao_offset_val, height);
2547         dst += 8;
2548         src += 8;
2549         width %= 8;
2550     }
2551
2552     if (width) {
2553         hevc_sao_band_filter_4width_msa(dst, stride_dst, src, stride_src,
2554                                         sao_left_class, sao_offset_val, height);
2555     }
2556 }
2557
2558 void ff_hevc_sao_edge_filter_8_msa(uint8_t *dst, uint8_t *src,
2559                                    ptrdiff_t stride_dst,
2560                                    int16_t *sao_offset_val,
2561                                    int eo, int width, int height)
2562 {
2563     ptrdiff_t stride_src = (2 * 64 + 32) / sizeof(uint8_t);
2564
2565     switch (eo) {
2566     case 0:
2567         if (width >> 4) {
2568             hevc_sao_edge_filter_0degree_16multiple_msa(dst, stride_dst,
2569                                                         src, stride_src,
2570                                                         sao_offset_val,
2571                                                         width - (width % 16),
2572                                                         height);
2573             dst += width - (width % 16);
2574             src += width - (width % 16);
2575             width %= 16;
2576         }
2577
2578         if (width >> 3) {
2579             hevc_sao_edge_filter_0degree_8width_msa(dst, stride_dst,
2580                                                     src, stride_src,
2581                                                     sao_offset_val, height);
2582             dst += 8;
2583             src += 8;
2584             width %= 8;
2585         }
2586
2587         if (width) {
2588             hevc_sao_edge_filter_0degree_4width_msa(dst, stride_dst,
2589                                                     src, stride_src,
2590                                                     sao_offset_val, height);
2591         }
2592         break;
2593
2594     case 1:
2595         if (width >> 4) {
2596             hevc_sao_edge_filter_90degree_16multiple_msa(dst, stride_dst,
2597                                                          src, stride_src,
2598                                                          sao_offset_val,
2599                                                          width - (width % 16),
2600                                                          height);
2601             dst += width - (width % 16);
2602             src += width - (width % 16);
2603             width %= 16;
2604         }
2605
2606         if (width >> 3) {
2607             hevc_sao_edge_filter_90degree_8width_msa(dst, stride_dst,
2608                                                      src, stride_src,
2609                                                      sao_offset_val, height);
2610             dst += 8;
2611             src += 8;
2612             width %= 8;
2613         }
2614
2615         if (width) {
2616             hevc_sao_edge_filter_90degree_4width_msa(dst, stride_dst,
2617                                                      src, stride_src,
2618                                                      sao_offset_val, height);
2619         }
2620         break;
2621
2622     case 2:
2623         if (width >> 4) {
2624             hevc_sao_edge_filter_45degree_16multiple_msa(dst, stride_dst,
2625                                                          src, stride_src,
2626                                                          sao_offset_val,
2627                                                          width - (width % 16),
2628                                                          height);
2629             dst += width - (width % 16);
2630             src += width - (width % 16);
2631             width %= 16;
2632         }
2633
2634         if (width >> 3) {
2635             hevc_sao_edge_filter_45degree_8width_msa(dst, stride_dst,
2636                                                      src, stride_src,
2637                                                      sao_offset_val, height);
2638             dst += 8;
2639             src += 8;
2640             width %= 8;
2641         }
2642
2643         if (width) {
2644             hevc_sao_edge_filter_45degree_4width_msa(dst, stride_dst,
2645                                                      src, stride_src,
2646                                                      sao_offset_val, height);
2647         }
2648         break;
2649
2650     case 3:
2651         if (width >> 4) {
2652             hevc_sao_edge_filter_135degree_16multiple_msa(dst, stride_dst,
2653                                                           src, stride_src,
2654                                                           sao_offset_val,
2655                                                           width - (width % 16),
2656                                                           height);
2657             dst += width - (width % 16);
2658             src += width - (width % 16);
2659             width %= 16;
2660         }
2661
2662         if (width >> 3) {
2663             hevc_sao_edge_filter_135degree_8width_msa(dst, stride_dst,
2664                                                       src, stride_src,
2665                                                       sao_offset_val, height);
2666             dst += 8;
2667             src += 8;
2668             width %= 8;
2669         }
2670
2671         if (width) {
2672             hevc_sao_edge_filter_135degree_4width_msa(dst, stride_dst,
2673                                                       src, stride_src,
2674                                                       sao_offset_val, height);
2675         }
2676         break;
2677     }
2678 }