123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972 |
- /*
- * Copyright (C) 2022 Loongson Technology Corporation Limited
- * Contributed by Hao Chen(chenhao@loongson.cn)
- *
- * This file is part of FFmpeg.
- *
- * FFmpeg is free software; you can redistribute it and/or
- * modify it under the terms of the GNU Lesser General Public
- * License as published by the Free Software Foundation; either
- * version 2.1 of the License, or (at your option) any later version.
- *
- * FFmpeg is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * Lesser General Public License for more details.
- *
- * You should have received a copy of the GNU Lesser General Public
- * License along with FFmpeg; if not, write to the Free Software
- * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
- */
- #include "swscale_loongarch.h"
- #include "libavutil/loongarch/loongson_intrinsics.h"
- #include "libavutil/intreadwrite.h"
- #define SCALE_8_16(_sh) \
- { \
- src0 = __lasx_xvldrepl_d(src + filterPos[0], 0); \
- src1 = __lasx_xvldrepl_d(src + filterPos[1], 0); \
- src2 = __lasx_xvldrepl_d(src + filterPos[2], 0); \
- src3 = __lasx_xvldrepl_d(src + filterPos[3], 0); \
- src4 = __lasx_xvldrepl_d(src + filterPos[4], 0); \
- src5 = __lasx_xvldrepl_d(src + filterPos[5], 0); \
- src6 = __lasx_xvldrepl_d(src + filterPos[6], 0); \
- src7 = __lasx_xvldrepl_d(src + filterPos[7], 0); \
- src8 = __lasx_xvldrepl_d(src + filterPos[8], 0); \
- src9 = __lasx_xvldrepl_d(src + filterPos[9], 0); \
- src10 = __lasx_xvldrepl_d(src + filterPos[10], 0); \
- src11 = __lasx_xvldrepl_d(src + filterPos[11], 0); \
- src12 = __lasx_xvldrepl_d(src + filterPos[12], 0); \
- src13 = __lasx_xvldrepl_d(src + filterPos[13], 0); \
- src14 = __lasx_xvldrepl_d(src + filterPos[14], 0); \
- src15 = __lasx_xvldrepl_d(src + filterPos[15], 0); \
- DUP4_ARG2(__lasx_xvld, filter, 0, filter, 32, filter, 64, \
- filter, 96, filter0, filter1, filter2, filter3); \
- DUP4_ARG2(__lasx_xvld, filter, 128, filter, 160, \
- filter, 192, filter, 224, filter4, \
- filter5, filter6, filter7); \
- DUP4_ARG2(__lasx_xvilvl_d, src1, src0, src3, src2, \
- src5, src4, src7, src6, src0, src2, src4, src6); \
- DUP4_ARG2(__lasx_xvilvl_d, src9, src8, src11, src10, \
- src13, src12, src15, src14, src8, src10, src12, src14); \
- DUP4_ARG1(__lasx_vext2xv_hu_bu, src0, src2, src4, src6, \
- src0, src2, src4, src6); \
- DUP4_ARG1(__lasx_vext2xv_hu_bu, src8, src10, src12, \
- src14, src8, src10, src12, src14); \
- DUP4_ARG2(__lasx_xvdp2_w_h, filter0, src0, filter1, src2, \
- filter2, src4, filter3, src6, src0, src1, src2, src3); \
- DUP4_ARG2(__lasx_xvdp2_w_h, filter4, src8, filter5, src10, \
- filter6, src12, filter7, src14, src4, src5, src6, src7);\
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src1 = __lasx_xvhaddw_d_w(src1, src1); \
- src2 = __lasx_xvhaddw_d_w(src2, src2); \
- src3 = __lasx_xvhaddw_d_w(src3, src3); \
- src4 = __lasx_xvhaddw_d_w(src4, src4); \
- src5 = __lasx_xvhaddw_d_w(src5, src5); \
- src6 = __lasx_xvhaddw_d_w(src6, src6); \
- src7 = __lasx_xvhaddw_d_w(src7, src7); \
- DUP4_ARG2(__lasx_xvpickev_w, src1, src0, src3, src2, \
- src5, src4, src7, src6, src0, src1, src2, src3); \
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src1 = __lasx_xvhaddw_d_w(src1, src1); \
- src2 = __lasx_xvhaddw_d_w(src2, src2); \
- src3 = __lasx_xvhaddw_d_w(src3, src3); \
- src0 = __lasx_xvpickev_w(src1, src0); \
- src1 = __lasx_xvpickev_w(src3, src2); \
- src0 = __lasx_xvsrai_w(src0, _sh); \
- src1 = __lasx_xvsrai_w(src1, _sh); \
- src0 = __lasx_xvmin_w(src0, vmax); \
- src1 = __lasx_xvmin_w(src1, vmax); \
- src0 = __lasx_xvperm_w(src0, shuf); \
- src1 = __lasx_xvperm_w(src1, shuf); \
- src0 = __lasx_xvpickev_h(src1, src0); \
- src0 = __lasx_xvpermi_d(src0, 0xd8); \
- __lasx_xvst(src0, dst, 0); \
- filterPos += 16; \
- filter += 128; \
- dst += 16; \
- }
- #define SCALE_8_8(_sh) \
- { \
- src0 = __lasx_xvldrepl_d(src + filterPos[0], 0); \
- src1 = __lasx_xvldrepl_d(src + filterPos[1], 0); \
- src2 = __lasx_xvldrepl_d(src + filterPos[2], 0); \
- src3 = __lasx_xvldrepl_d(src + filterPos[3], 0); \
- src4 = __lasx_xvldrepl_d(src + filterPos[4], 0); \
- src5 = __lasx_xvldrepl_d(src + filterPos[5], 0); \
- src6 = __lasx_xvldrepl_d(src + filterPos[6], 0); \
- src7 = __lasx_xvldrepl_d(src + filterPos[7], 0); \
- DUP4_ARG2(__lasx_xvld, filter, 0, filter, 32, filter, 64, \
- filter, 96, filter0, filter1, filter2, filter3); \
- filterPos += 8; \
- filter += 64; \
- DUP4_ARG2(__lasx_xvilvl_d, src1, src0, src3, src2, \
- src5, src4, src7, src6, src0, src2, src4, src6); \
- DUP4_ARG1(__lasx_vext2xv_hu_bu, src0, src2, src4, src6, \
- src0, src2, src4, src6); \
- DUP4_ARG2(__lasx_xvdp2_w_h, filter0, src0, filter1, src2, \
- filter2, src4, filter3, src6, src0, src1, src2,src3); \
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src1 = __lasx_xvhaddw_d_w(src1, src1); \
- src2 = __lasx_xvhaddw_d_w(src2, src2); \
- src3 = __lasx_xvhaddw_d_w(src3, src3); \
- src0 = __lasx_xvpickev_w(src1, src0); \
- src1 = __lasx_xvpickev_w(src3, src2); \
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src1 = __lasx_xvhaddw_d_w(src1, src1); \
- src0 = __lasx_xvpickev_w(src1, src0); \
- src0 = __lasx_xvsrai_w(src0, _sh); \
- src0 = __lasx_xvmin_w(src0, vmax); \
- src0 = __lasx_xvperm_w(src0, shuf); \
- }
- #define SCALE_8_4(_sh) \
- { \
- src0 = __lasx_xvldrepl_d(src + filterPos[0], 0); \
- src1 = __lasx_xvldrepl_d(src + filterPos[1], 0); \
- src2 = __lasx_xvldrepl_d(src + filterPos[2], 0); \
- src3 = __lasx_xvldrepl_d(src + filterPos[3], 0); \
- filter0 = __lasx_xvld(filter, 0); \
- filter1 = __lasx_xvld(filter, 32); \
- filterPos += 4; \
- filter += 32; \
- src0 = __lasx_xvilvl_d(src1, src0); \
- src2 = __lasx_xvilvl_d(src3, src2); \
- src0 = __lasx_vext2xv_hu_bu(src0); \
- src2 = __lasx_vext2xv_hu_bu(src2); \
- src0 = __lasx_xvdp2_w_h(src0, filter0); \
- src1 = __lasx_xvdp2_w_h(src2, filter1); \
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src1 = __lasx_xvhaddw_d_w(src1, src1); \
- src0 = __lasx_xvpickev_w(src1, src0); \
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src0 = __lasx_xvpickev_w(src0, src0); \
- src0 = __lasx_xvsrai_w(src0, _sh); \
- src0 = __lasx_xvmin_w(src0, vmax); \
- src0 = __lasx_xvperm_w(src0, shuf); \
- }
- #define SCALE_8_2(_sh) \
- { \
- src0 = __lasx_xvldrepl_d(src + filterPos[0], 0); \
- src1 = __lasx_xvldrepl_d(src + filterPos[1], 0); \
- filter0 = __lasx_xvld(filter, 0); \
- src0 = __lasx_xvilvl_d(src1, src0); \
- src0 = __lasx_vext2xv_hu_bu(src0); \
- src0 = __lasx_xvdp2_w_h(filter0, src0); \
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src0 = __lasx_xvhaddw_q_d(src0, src0); \
- src0 = __lasx_xvsrai_w(src0, _sh); \
- src0 = __lasx_xvmin_w(src0, vmax); \
- dst[0] = __lasx_xvpickve2gr_w(src0, 0); \
- dst[1] = __lasx_xvpickve2gr_w(src0, 4); \
- filterPos += 2; \
- filter += 16; \
- dst += 2; \
- }
- #define SCALE_4_16(_sh) \
- { \
- src0 = __lasx_xvldrepl_w(src + filterPos[0], 0); \
- src1 = __lasx_xvldrepl_w(src + filterPos[1], 0); \
- src2 = __lasx_xvldrepl_w(src + filterPos[2], 0); \
- src3 = __lasx_xvldrepl_w(src + filterPos[3], 0); \
- src4 = __lasx_xvldrepl_w(src + filterPos[4], 0); \
- src5 = __lasx_xvldrepl_w(src + filterPos[5], 0); \
- src6 = __lasx_xvldrepl_w(src + filterPos[6], 0); \
- src7 = __lasx_xvldrepl_w(src + filterPos[7], 0); \
- src8 = __lasx_xvldrepl_w(src + filterPos[8], 0); \
- src9 = __lasx_xvldrepl_w(src + filterPos[9], 0); \
- src10 = __lasx_xvldrepl_w(src + filterPos[10], 0); \
- src11 = __lasx_xvldrepl_w(src + filterPos[11], 0); \
- src12 = __lasx_xvldrepl_w(src + filterPos[12], 0); \
- src13 = __lasx_xvldrepl_w(src + filterPos[13], 0); \
- src14 = __lasx_xvldrepl_w(src + filterPos[14], 0); \
- src15 = __lasx_xvldrepl_w(src + filterPos[15], 0); \
- DUP4_ARG2(__lasx_xvld, filter, 0, filter, 32, filter, 64, \
- filter, 96, filter0, filter1, filter2, filter3); \
- DUP4_ARG2(__lasx_xvilvl_w, src1, src0, src3, src2, src5, \
- src4, src7, src6, src0, src2, src4, src6); \
- DUP4_ARG2(__lasx_xvilvl_w, src9, src8, src11, src10, src13, \
- src12, src15, src14, src8, src10, src12, src14); \
- DUP4_ARG2(__lasx_xvilvl_d, src2, src0, src6, src4, src10, \
- src8, src14, src12, src0, src1, src2, src3); \
- DUP4_ARG1(__lasx_vext2xv_hu_bu, src0, src1, src2, src3, \
- src0, src1, src2, src3); \
- DUP4_ARG2(__lasx_xvdp2_w_h, filter0, src0, filter1, src1, \
- filter2, src2, filter3, src3, src0, src1, src2, src3); \
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src1 = __lasx_xvhaddw_d_w(src1, src1); \
- src2 = __lasx_xvhaddw_d_w(src2, src2); \
- src3 = __lasx_xvhaddw_d_w(src3, src3); \
- src0 = __lasx_xvpickev_w(src1, src0); \
- src1 = __lasx_xvpickev_w(src3, src2); \
- src0 = __lasx_xvsrai_w(src0, _sh); \
- src1 = __lasx_xvsrai_w(src1, _sh); \
- src0 = __lasx_xvmin_w(src0, vmax); \
- src1 = __lasx_xvmin_w(src1, vmax); \
- src0 = __lasx_xvpickev_h(src1, src0); \
- src0 = __lasx_xvperm_w(src0, shuf); \
- __lasx_xvst(src0, dst, 0); \
- filterPos += 16; \
- filter += 64; \
- dst += 16; \
- }
- #define SCALE_4_8(_sh) \
- { \
- src0 = __lasx_xvldrepl_w(src + filterPos[0], 0); \
- src1 = __lasx_xvldrepl_w(src + filterPos[1], 0); \
- src2 = __lasx_xvldrepl_w(src + filterPos[2], 0); \
- src3 = __lasx_xvldrepl_w(src + filterPos[3], 0); \
- src4 = __lasx_xvldrepl_w(src + filterPos[4], 0); \
- src5 = __lasx_xvldrepl_w(src + filterPos[5], 0); \
- src6 = __lasx_xvldrepl_w(src + filterPos[6], 0); \
- src7 = __lasx_xvldrepl_w(src + filterPos[7], 0); \
- filter0 = __lasx_xvld(filter, 0); \
- filter1 = __lasx_xvld(filter, 32); \
- filterPos += 8; \
- filter += 32; \
- DUP4_ARG2(__lasx_xvilvl_w, src1, src0, src3, src2, src5, \
- src4, src7, src6, src0, src2, src4, src6); \
- src0 = __lasx_xvilvl_d(src2, src0); \
- src1 = __lasx_xvilvl_d(src6, src4); \
- \
- src0 = __lasx_vext2xv_hu_bu(src0); \
- src1 = __lasx_vext2xv_hu_bu(src1); \
- src0 = __lasx_xvdp2_w_h(filter0, src0); \
- src1 = __lasx_xvdp2_w_h(filter1, src1); \
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src1 = __lasx_xvhaddw_d_w(src1, src1); \
- src0 = __lasx_xvpickev_w(src1, src0); \
- src0 = __lasx_xvsrai_w(src0, _sh); \
- src0 = __lasx_xvmin_w(src0, vmax); \
- }
- #define SCALE_4_4(_sh) \
- { \
- src0 = __lasx_xvldrepl_w(src + filterPos[0], 0); \
- src1 = __lasx_xvldrepl_w(src + filterPos[1], 0); \
- src2 = __lasx_xvldrepl_w(src + filterPos[2], 0); \
- src3 = __lasx_xvldrepl_w(src + filterPos[3], 0); \
- filter0 = __lasx_xvld(filter, 0); \
- filterPos += 4; \
- filter += 16; \
- src0 = __lasx_xvilvl_w(src1, src0); \
- src1 = __lasx_xvilvl_w(src3, src2); \
- \
- src0 = __lasx_xvilvl_d(src1, src0); \
- src0 = __lasx_vext2xv_hu_bu(src0); \
- src0 = __lasx_xvdp2_w_h(filter0, src0); \
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src0 = __lasx_xvsrai_w(src0, _sh); \
- src0 = __lasx_xvmin_w(src0, vmax); \
- src0 = __lasx_xvpickev_w(src0, src0); \
- src0 = __lasx_xvpermi_d(src0, 0xd8); \
- }
- #define SCALE_4_2(_sh) \
- { \
- src0 = __lasx_xvldrepl_w(src + filterPos[0], 0); \
- src1 = __lasx_xvldrepl_w(src + filterPos[1], 0); \
- filter0 = __lasx_xvld(filter, 0); \
- src0 = __lasx_xvilvl_w(src1, src0); \
- src0 = __lasx_vext2xv_hu_bu(src0); \
- src0 = __lasx_xvdp2_w_h(filter0, src0); \
- src0 = __lasx_xvhaddw_d_w(src0, src0); \
- src0 = __lasx_xvsrai_w(src0, _sh); \
- src0 = __lasx_xvmin_w(src0, vmax); \
- dst[0] = __lasx_xvpickve2gr_w(src0, 0); \
- dst[1] = __lasx_xvpickve2gr_w(src0, 2); \
- filterPos += 2; \
- filter += 8; \
- dst += 2; \
- }
- #define SCALE_16 \
- { \
- int dex = j << 1; \
- src0 = __lasx_xvldrepl_d((srcPos1 + j), 0); \
- src1 = __lasx_xvldrepl_d((srcPos2 + j), 0); \
- src2 = __lasx_xvldrepl_d((srcPos3 + j), 0); \
- src3 = __lasx_xvldrepl_d((srcPos4 + j), 0); \
- DUP4_ARG2(__lasx_xvldx, filterStart1, dex, filterStart2, dex, \
- filterStart3, dex, filterStart4, dex, filter0, \
- filter1, filter2, filter3); \
- src0 = __lasx_xvpermi_q(src0, src1, 0x02); \
- src1 = __lasx_xvpermi_q(src2, src3, 0x02); \
- filter0 = __lasx_xvpermi_q(filter0, filter1, 0x02); \
- filter1 = __lasx_xvpermi_q(filter2, filter3, 0x02); \
- src0 = __lasx_xvilvl_b(zero, src0); \
- src1 = __lasx_xvilvl_b(zero, src1); \
- out0 = __lasx_xvdp2_w_h(filter0, src0); \
- out1 = __lasx_xvdp2_w_h(filter1, src1); \
- src0 = __lasx_xvhaddw_d_w(out0, out0); \
- src1 = __lasx_xvhaddw_d_w(out1, out1); \
- out0 = __lasx_xvpackev_d(src1, src0); \
- out1 = __lasx_xvpackod_d(src1, src0); \
- out0 = __lasx_xvadd_w(out0, out1); \
- out = __lasx_xvadd_w(out, out0); \
- }
- void ff_hscale_8_to_15_lasx(SwsContext *c, int16_t *dst, int dstW,
- const uint8_t *src, const int16_t *filter,
- const int32_t *filterPos, int filterSize)
- {
- int i;
- int max = (1 << 15) - 1;
- if (filterSize == 8) {
- __m256i src0, src1, src2, src3, src4, src5, src6, src7;
- __m256i src8, src9, src10, src11, src12, src13, src14, src15;
- __m256i filter0, filter1, filter2, filter3;
- __m256i filter4, filter5, filter6, filter7;
- __m256i vmax = __lasx_xvreplgr2vr_w(max);
- __m256i shuf = {0x0000000400000000, 0x0000000500000001,
- 0x0000000600000002, 0x0000000700000003};
- int len = dstW >> 4;
- int res = dstW & 15;
- while (len--) {
- SCALE_8_16(7);
- }
- if (res & 8) {
- SCALE_8_8(7);
- src0 = __lasx_xvpickev_h(src0, src0);
- __lasx_xvstelm_d(src0, dst, 0, 0);
- __lasx_xvstelm_d(src0, dst, 8, 2);
- dst += 8;
- }
- if (res & 4) {
- SCALE_8_4(7);
- src0 = __lasx_xvpickev_h(src0, src0);
- __lasx_xvstelm_d(src0, dst, 0, 0);
- dst += 4;
- }
- if (res & 2) {
- SCALE_8_2(7);
- }
- if (res & 1) {
- int val = 0;
- src0 = __lasx_xvldrepl_d(src + filterPos[0], 0);
- filter0 = __lasx_xvld(filter, 0);
- src0 = __lasx_vext2xv_hu_bu(src0);
- src0 = __lasx_xvdp2_w_h(filter0, src0);
- src0 = __lasx_xvhaddw_d_w(src0, src0);
- src0 = __lasx_xvhaddw_q_d(src0, src0);
- val = __lasx_xvpickve2gr_w(src0, 0);
- dst[0] = FFMIN(val >> 7, max);
- }
- } else if (filterSize == 4) {
- __m256i src0, src1, src2, src3, src4, src5, src6, src7;
- __m256i src8, src9, src10, src11, src12, src13, src14, src15;
- __m256i filter0, filter1, filter2, filter3;
- __m256i vmax = __lasx_xvreplgr2vr_w(max);
- __m256i shuf = {0x0000000400000000, 0x0000000500000001,
- 0x0000000600000002, 0x0000000700000003};
- int len = dstW >> 4;
- int res = dstW & 15;
- while (len--) {
- SCALE_4_16(7);
- }
- if (res & 8) {
- SCALE_4_8(7);
- src0 = __lasx_xvpickev_h(src1, src0);
- src0 = __lasx_xvperm_w(src0, shuf);
- __lasx_xvstelm_d(src0, dst, 0, 0);
- __lasx_xvstelm_d(src0, dst, 8, 1);
- dst += 8;
- }
- if (res & 4) {
- SCALE_4_4(7);
- src0 = __lasx_xvpickev_h(src0, src0);
- __lasx_xvstelm_d(src0, dst, 0, 0);
- dst += 4;
- }
- if (res & 2) {
- SCALE_4_2(7);
- }
- if (res & 1) {
- int val = 0;
- const uint8_t *srcPos = src + filterPos[0];
- for (int j = 0; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[0] = FFMIN(val >> 7, max);
- }
- } else if (filterSize > 8) {
- int filterlen = filterSize - 7;
- int len = dstW >> 2;
- int res = dstW & 3;
- __m256i zero = __lasx_xvldi(0);
- while (len--) {
- __m256i src0, src1, src2, src3;
- __m256i filter0, filter1, filter2, filter3, out0, out1;
- __m256i out = zero;
- const uint8_t *srcPos1 = src + filterPos[0];
- const uint8_t *srcPos2 = src + filterPos[1];
- const uint8_t *srcPos3 = src + filterPos[2];
- const uint8_t *srcPos4 = src + filterPos[3];
- const int16_t *filterStart1 = filter;
- const int16_t *filterStart2 = filterStart1 + filterSize;
- const int16_t *filterStart3 = filterStart2 + filterSize;
- const int16_t *filterStart4 = filterStart3 + filterSize;
- int j, val1 = 0, val2 = 0, val3 = 0, val4 = 0;
- for (j = 0; j < filterlen; j += 8) {
- SCALE_16
- }
- val1 = __lasx_xvpickve2gr_w(out, 0);
- val2 = __lasx_xvpickve2gr_w(out, 4);
- val3 = __lasx_xvpickve2gr_w(out, 2);
- val4 = __lasx_xvpickve2gr_w(out, 6);
- for (; j < filterSize; j++) {
- val1 += ((int)srcPos1[j]) * filterStart1[j];
- val2 += ((int)srcPos2[j]) * filterStart2[j];
- val3 += ((int)srcPos3[j]) * filterStart3[j];
- val4 += ((int)srcPos4[j]) * filterStart4[j];
- }
- dst[0] = FFMIN(val1 >> 7, max);
- dst[1] = FFMIN(val2 >> 7, max);
- dst[2] = FFMIN(val3 >> 7, max);
- dst[3] = FFMIN(val4 >> 7, max);
- dst += 4;
- filterPos += 4;
- filter = filterStart4 + filterSize;
- }
- for(i = 0; i < res; i++) {
- int j, val = 0;
- const uint8_t *srcPos = src + filterPos[i];
- __m256i src1, filter0, out0;
- for (j = 0; j < filterlen; j += 8) {
- src1 = __lasx_xvldrepl_d((srcPos + j), 0);
- filter0 = __lasx_xvld(filter + j, 0);
- src1 = __lasx_xvilvl_b(zero, src1);
- out0 = __lasx_xvdp2_w_h(filter0, src1);
- out0 = __lasx_xvhaddw_d_w(out0, out0);
- out0 = __lasx_xvhaddw_q_d(out0, out0);
- val += __lasx_xvpickve2gr_w(out0, 0);
- }
- for (; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[i] = FFMIN(val >> 7, max);
- filter += filterSize;
- }
- } else {
- for (i = 0; i < dstW; i++) {
- int val = 0;
- const uint8_t *srcPos = src + filterPos[i];
- for (int j = 0; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[i] = FFMIN(val >> 7, max);
- filter += filterSize;
- }
- }
- }
- void ff_hscale_8_to_19_lasx(SwsContext *c, int16_t *_dst, int dstW,
- const uint8_t *src, const int16_t *filter,
- const int32_t *filterPos, int filterSize)
- {
- int i;
- int max = (1 << 19) - 1;
- int32_t *dst = (int32_t *) _dst;
- if (filterSize == 8) {
- __m256i src0, src1, src2, src3, src4, src5, src6, src7;
- __m256i filter0, filter1, filter2, filter3;
- __m256i vmax = __lasx_xvreplgr2vr_w(max);
- __m256i shuf = {0x0000000400000000, 0x0000000500000001,
- 0x0000000600000002, 0x0000000700000003};
- int len = dstW >> 3;
- int res = dstW & 7;
- while (len--) {
- SCALE_8_8(3);
- __lasx_xvst(src0, dst, 0);
- dst += 8;
- }
- if (res & 4) {
- SCALE_8_4(3);
- __lasx_xvstelm_d(src0, dst, 0, 0);
- __lasx_xvstelm_d(src0, dst, 8, 1);
- dst += 4;
- }
- if (res & 2) {
- SCALE_8_2(3);
- }
- if (res & 1) {
- int val = 0;
- __m256i src0, filter0, out0;
- src0 = __lasx_xvldrepl_d(src + filterPos[0], 0);
- filter0 = __lasx_xvld(filter, 0);
- src0 = __lasx_vext2xv_hu_bu(src0);
- out0 = __lasx_xvdp2_w_h(filter0, src0);
- out0 = __lasx_xvhaddw_d_w(out0, out0);
- out0 = __lasx_xvhaddw_q_d(out0, out0);
- val = __lasx_xvpickve2gr_w(out0, 0);
- dst[0] = FFMIN(val >> 3, max);
- }
- } else if (filterSize == 4) {
- __m256i src0, src1, src2, src3, src4, src5, src6, src7;
- __m256i filter0, filter1;
- __m256i vmax = __lasx_xvreplgr2vr_w(max);
- __m256i shuf = {0x0000000100000000, 0x0000000500000004,
- 0x0000000300000002, 0x0000000700000006};
- int len = dstW >> 3;
- int res = dstW & 7;
- while (len--) {
- SCALE_4_8(3);
- src0 = __lasx_xvperm_w(src0, shuf);
- __lasx_xvst(src0, dst, 0);
- dst += 8;
- }
- if (res & 4) {
- SCALE_4_4(3);
- __lasx_xvstelm_d(src0, dst, 0, 0);
- __lasx_xvstelm_d(src0, dst, 8, 1);
- dst += 4;
- }
- if (res & 2) {
- SCALE_4_2(3);
- }
- if (res & 1) {
- int val = 0;
- const uint8_t *srcPos = src + filterPos[0];
- for (int j = 0; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[0] = FFMIN(val >> 3, max);
- }
- } else if (filterSize > 8) {
- int len = dstW >> 2;
- int res = dstW & 3;
- int filterlen = filterSize - 7;
- __m256i zero = __lasx_xvldi(0);
- while (len--) {
- __m256i src0, src1, src2, src3;
- __m256i filter0, filter1, filter2, filter3, out0, out1;
- __m256i out = zero;
- const uint8_t *srcPos1 = src + filterPos[0];
- const uint8_t *srcPos2 = src + filterPos[1];
- const uint8_t *srcPos3 = src + filterPos[2];
- const uint8_t *srcPos4 = src + filterPos[3];
- const int16_t *filterStart1 = filter;
- const int16_t *filterStart2 = filterStart1 + filterSize;
- const int16_t *filterStart3 = filterStart2 + filterSize;
- const int16_t *filterStart4 = filterStart3 + filterSize;
- int j, val1 = 0, val2 = 0, val3 = 0, val4 = 0;
- for (j = 0; j < filterlen; j += 8) {
- SCALE_16
- }
- val1 = __lasx_xvpickve2gr_w(out, 0);
- val2 = __lasx_xvpickve2gr_w(out, 4);
- val3 = __lasx_xvpickve2gr_w(out, 2);
- val4 = __lasx_xvpickve2gr_w(out, 6);
- for (; j < filterSize; j++) {
- val1 += ((int)srcPos1[j]) * filterStart1[j];
- val2 += ((int)srcPos2[j]) * filterStart2[j];
- val3 += ((int)srcPos3[j]) * filterStart3[j];
- val4 += ((int)srcPos4[j]) * filterStart4[j];
- }
- dst[0] = FFMIN(val1 >> 3, max);
- dst[1] = FFMIN(val2 >> 3, max);
- dst[2] = FFMIN(val3 >> 3, max);
- dst[3] = FFMIN(val4 >> 3, max);
- dst += 4;
- filterPos += 4;
- filter = filterStart4 + filterSize;
- }
- for (i = 0; i < res; i++) {
- int j, val = 0;
- const uint8_t *srcPos = src + filterPos[i];
- __m256i src1, filter0, out0;
- for (j = 0; j < filterlen; j += 8) {
- src1 = __lasx_xvldrepl_d((srcPos + j), 0);
- filter0 = __lasx_xvld(filter + j, 0);
- src1 = __lasx_xvilvl_b(zero, src1);
- out0 = __lasx_xvdp2_w_h(filter0, src1);
- out0 = __lasx_xvhaddw_d_w(out0, out0);
- out0 = __lasx_xvhaddw_q_d(out0, out0);
- val += __lasx_xvpickve2gr_w(out0, 0);
- }
- for (; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[i] = FFMIN(val >> 3, max);
- filter += filterSize;
- }
- } else {
- for (i = 0; i < dstW; i++) {
- int val = 0;
- const uint8_t *srcPos = src + filterPos[i];
- for (int j = 0; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[i] = FFMIN(val >> 3, max);
- filter += filterSize;
- }
- }
- }
- #undef SCALE_16
- #define SCALE_8 \
- { \
- __m256i src0, src1, src2, src3, filter0, filter1, out0, out1; \
- DUP4_ARG2(__lasx_xvld, src + filterPos[0], 0, src + filterPos[1], 0, \
- src + filterPos[2], 0, src + filterPos[3], 0, src0, src1, src2,\
- src3); \
- filter0 = __lasx_xvld(filter, 0); \
- filter1 = __lasx_xvld(filter, 32); \
- src0 = __lasx_xvpermi_q(src0, src1, 0x02); \
- src2 = __lasx_xvpermi_q(src2, src3, 0x02); \
- out0 = __lasx_xvdp2_w_hu_h(src0, filter0); \
- out1 = __lasx_xvdp2_w_hu_h(src2, filter1); \
- src0 = __lasx_xvhaddw_d_w(out0, out0); \
- src1 = __lasx_xvhaddw_d_w(out1, out1); \
- out0 = __lasx_xvpackev_d(src1, src0); \
- out1 = __lasx_xvpackod_d(src1, src0); \
- out0 = __lasx_xvadd_w(out0, out1); \
- out0 = __lasx_xvsra_w(out0, shift); \
- out0 = __lasx_xvmin_w(out0, v_max); \
- dst[0] = __lasx_xvpickve2gr_w(out0, 0); \
- dst[1] = __lasx_xvpickve2gr_w(out0, 4); \
- dst[2] = __lasx_xvpickve2gr_w(out0, 2); \
- dst[3] = __lasx_xvpickve2gr_w(out0, 6); \
- filterPos += 4; \
- filter += 32; \
- dst += 4; \
- }
- #define SCALE_16 \
- { \
- int dex = j << 1; \
- DUP4_ARG2(__lasx_xvldx, srcPos1, dex, srcPos2, dex, srcPos3, dex, \
- srcPos4, dex, src0, src1, src2, src3); \
- DUP4_ARG2(__lasx_xvldx, filterStart1, dex, filterStart2, dex, \
- filterStart3, dex, filterStart4, dex, filter0, \
- filter1, filter2, filter3); \
- src0 = __lasx_xvpermi_q(src0, src1, 0x02); \
- src1 = __lasx_xvpermi_q(src2, src3, 0x02); \
- filter0 = __lasx_xvpermi_q(filter0, filter1, 0x02); \
- filter1 = __lasx_xvpermi_q(filter2, filter3, 0x02); \
- out0 = __lasx_xvdp2_w_hu_h(src0, filter0); \
- out1 = __lasx_xvdp2_w_hu_h(src1, filter1); \
- src0 = __lasx_xvhaddw_d_w(out0, out0); \
- src1 = __lasx_xvhaddw_d_w(out1, out1); \
- out0 = __lasx_xvpackev_d(src1, src0); \
- out1 = __lasx_xvpackod_d(src1, src0); \
- out0 = __lasx_xvadd_w(out0, out1); \
- out = __lasx_xvadd_w(out, out0); \
- }
- void ff_hscale_16_to_15_lasx(SwsContext *c, int16_t *dst, int dstW,
- const uint8_t *_src, const int16_t *filter,
- const int32_t *filterPos, int filterSize)
- {
- const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(c->srcFormat);
- int i;
- const uint16_t *src = (const uint16_t *) _src;
- int sh = desc->comp[0].depth - 1;
- int max = (1 << 15) - 1;
- int len = dstW >> 2;
- int res = dstW & 3;
- __m256i shift;
- __m256i zero = __lasx_xvldi(0);
- if (sh < 15) {
- sh = isAnyRGB(c->srcFormat) || c->srcFormat==AV_PIX_FMT_PAL8 ? 13 :
- (desc->comp[0].depth - 1);
- } else if (desc->flags && AV_PIX_FMT_FLAG_FLOAT) {
- sh = 15;
- }
- shift = __lasx_xvreplgr2vr_w(sh);
- if (filterSize == 8) {
- __m256i v_max = __lasx_xvreplgr2vr_w(max);
- for (i = 0; i < len; i++) {
- SCALE_8
- }
- for (i = 0; i < res; i++) {
- int val = 0;
- __m256i src0, filter0, out0;
- src0 = __lasx_xvld(src + filterPos[i], 0);
- filter0 = __lasx_xvld(filter, 0);
- out0 = __lasx_xvdp2_w_hu_h(src0, filter0);
- out0 = __lasx_xvhaddw_d_w(out0, out0);
- out0 = __lasx_xvhaddw_q_d(out0, out0);
- val = __lasx_xvpickve2gr_w(out0, 0);
- dst[i] = FFMIN(val >> sh, max);
- filter += 8;
- }
- } else if (filterSize == 4) {
- __m256i v_max = __lasx_xvreplgr2vr_w(max);
- for (i = 0; i < len; i++) {
- __m256i src1, src2, src3, src4, src0, filter0, out0;
- src1 = __lasx_xvldrepl_d(src + filterPos[0], 0);
- src2 = __lasx_xvldrepl_d(src + filterPos[1], 0);
- src3 = __lasx_xvldrepl_d(src + filterPos[2], 0);
- src4 = __lasx_xvldrepl_d(src + filterPos[3], 0);
- filter0 = __lasx_xvld(filter, 0);
- src1 = __lasx_xvextrins_d(src1, src2, 0x10);
- src3 = __lasx_xvextrins_d(src3, src4, 0x10);
- src0 = __lasx_xvpermi_q(src1, src3, 0x02);
- out0 = __lasx_xvdp2_w_hu_h(src0, filter0);
- out0 = __lasx_xvhaddw_d_w(out0, out0);
- out0 = __lasx_xvsra_w(out0, shift);
- out0 = __lasx_xvmin_w(out0, v_max);
- dst[0] = __lasx_xvpickve2gr_w(out0, 0);
- dst[1] = __lasx_xvpickve2gr_w(out0, 2);
- dst[2] = __lasx_xvpickve2gr_w(out0, 4);
- dst[3] = __lasx_xvpickve2gr_w(out0, 6);
- dst += 4;
- filterPos += 4;
- filter += 16;
- }
- for (i = 0; i < res; i++) {
- int val = 0;
- const uint16_t *srcPos = src + filterPos[i];
- for (int j = 0; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[i] = FFMIN(val >> sh, max);
- filter += 4;
- }
- } else if (filterSize > 8) {
- int filterlen = filterSize - 7;
- for (i = 0; i < len; i++) {
- __m256i src0, src1, src2, src3;
- __m256i filter0, filter1, filter2, filter3, out0, out1;
- __m256i out = zero;
- const uint16_t *srcPos1 = src + filterPos[0];
- const uint16_t *srcPos2 = src + filterPos[1];
- const uint16_t *srcPos3 = src + filterPos[2];
- const uint16_t *srcPos4 = src + filterPos[3];
- const int16_t *filterStart1 = filter;
- const int16_t *filterStart2 = filterStart1 + filterSize;
- const int16_t *filterStart3 = filterStart2 + filterSize;
- const int16_t *filterStart4 = filterStart3 + filterSize;
- int j, val1 = 0, val2 = 0, val3 = 0, val4 = 0;
- for (j = 0; j < filterlen; j += 8) {
- SCALE_16
- }
- val1 = __lasx_xvpickve2gr_w(out, 0);
- val2 = __lasx_xvpickve2gr_w(out, 4);
- val3 = __lasx_xvpickve2gr_w(out, 2);
- val4 = __lasx_xvpickve2gr_w(out, 6);
- for (; j < filterSize; j++) {
- val1 += ((int)srcPos1[j]) * filterStart1[j];
- val2 += ((int)srcPos2[j]) * filterStart2[j];
- val3 += ((int)srcPos3[j]) * filterStart3[j];
- val4 += ((int)srcPos4[j]) * filterStart4[j];
- }
- dst[0] = FFMIN(val1 >> sh, max);
- dst[1] = FFMIN(val2 >> sh, max);
- dst[2] = FFMIN(val3 >> sh, max);
- dst[3] = FFMIN(val4 >> sh, max);
- dst += 4;
- filterPos += 4;
- filter = filterStart4 + filterSize;
- }
- for (i = 0; i < res; i++) {
- int j, val = 0;
- const uint16_t *srcPos = src + filterPos[i];
- __m256i src0, filter0, out0;
- for (j = 0; j < filterlen; j += 8) {
- int dex = j << 1;
- src0 = __lasx_xvldx(srcPos, dex);
- filter0 = __lasx_xvldx(filter, dex);
- out0 = __lasx_xvdp2_w_hu_h(src0, filter0);
- out0 = __lasx_xvhaddw_d_w(out0, out0);
- out0 = __lasx_xvhaddw_q_d(out0, out0);
- val += __lasx_xvpickve2gr_w(out0, 0);
- }
- for (; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[i] = FFMIN(val >> sh, max);
- filter += filterSize;
- }
- } else {
- for (i = 0; i < dstW; i++) {
- int val = 0;
- const uint16_t *srcPos = src + filterPos[i];
- for (int j = 0; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[i] = FFMIN(val >> sh, max);
- filter += filterSize;
- }
- }
- }
- void ff_hscale_16_to_19_lasx(SwsContext *c, int16_t *_dst, int dstW,
- const uint8_t *_src, const int16_t *filter,
- const int32_t *filterPos, int filterSize)
- {
- const AVPixFmtDescriptor *desc = av_pix_fmt_desc_get(c->srcFormat);
- int i;
- int32_t *dst = (int32_t *) _dst;
- const uint16_t *src = (const uint16_t *) _src;
- int sh = desc->comp[0].depth - 5;
- int max = (1 << 19) - 1;
- int len = dstW >> 2;
- int res = dstW & 3;
- __m256i shift;
- __m256i zero = __lasx_xvldi(0);
- if ((isAnyRGB(c->srcFormat) || c->srcFormat == AV_PIX_FMT_PAL8)
- && desc->comp[0].depth<16) {
- sh = 9;
- } else if (desc->flags & AV_PIX_FMT_FLAG_FLOAT) {
- sh = 11;
- }
- shift = __lasx_xvreplgr2vr_w(sh);
- if (filterSize == 8) {
- __m256i v_max = __lasx_xvreplgr2vr_w(max);
- for (i = 0; i < len; i++) {
- SCALE_8
- }
- for (i = 0; i < res; i++) {
- int val = 0;
- __m256i src0, filter0, out0;
- src0 = __lasx_xvld(src + filterPos[i], 0);
- filter0 = __lasx_xvld(filter, 0);
- out0 = __lasx_xvdp2_w_hu_h(src0, filter0);
- out0 = __lasx_xvhaddw_d_w(out0, out0);
- out0 = __lasx_xvhaddw_q_d(out0, out0);
- val = __lasx_xvpickve2gr_w(out0, 0);
- dst[i] = FFMIN(val >> sh, max);
- filter += 8;
- }
- } else if (filterSize == 4) {
- __m256i v_max = __lasx_xvreplgr2vr_w(max);
- for (i = 0; i < len; i++) {
- __m256i src1, src2, src3, src4, src0, filter0, out0;
- src1 = __lasx_xvldrepl_d(src + filterPos[0], 0);
- src2 = __lasx_xvldrepl_d(src + filterPos[1], 0);
- src3 = __lasx_xvldrepl_d(src + filterPos[2], 0);
- src4 = __lasx_xvldrepl_d(src + filterPos[3], 0);
- filter0 = __lasx_xvld(filter, 0);
- src1 = __lasx_xvextrins_d(src1, src2, 0x10);
- src3 = __lasx_xvextrins_d(src3, src4, 0x10);
- src0 = __lasx_xvpermi_q(src1, src3, 0x02);
- out0 = __lasx_xvdp2_w_hu_h(src0, filter0);
- out0 = __lasx_xvhaddw_d_w(out0, out0);
- out0 = __lasx_xvsra_w(out0, shift);
- out0 = __lasx_xvmin_w(out0, v_max);
- dst[0] = __lasx_xvpickve2gr_w(out0, 0);
- dst[1] = __lasx_xvpickve2gr_w(out0, 2);
- dst[2] = __lasx_xvpickve2gr_w(out0, 4);
- dst[3] = __lasx_xvpickve2gr_w(out0, 6);
- dst += 4;
- filterPos += 4;
- filter += 16;
- }
- for (i = 0; i < res; i++) {
- int val = 0;
- const uint16_t *srcPos = src + filterPos[i];
- for (int j = 0; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[i] = FFMIN(val >> sh, max);
- filter += 4;
- }
- } else if (filterSize > 8) {
- int filterlen = filterSize - 7;
- for (i = 0; i < len; i ++) {
- __m256i src0, src1, src2, src3;
- __m256i filter0, filter1, filter2, filter3, out0, out1;
- __m256i out = zero;
- const uint16_t *srcPos1 = src + filterPos[0];
- const uint16_t *srcPos2 = src + filterPos[1];
- const uint16_t *srcPos3 = src + filterPos[2];
- const uint16_t *srcPos4 = src + filterPos[3];
- const int16_t *filterStart1 = filter;
- const int16_t *filterStart2 = filterStart1 + filterSize;
- const int16_t *filterStart3 = filterStart2 + filterSize;
- const int16_t *filterStart4 = filterStart3 + filterSize;
- int j, val1 = 0, val2 = 0, val3 = 0, val4 = 0;
- for (j = 0; j < filterlen; j += 8) {
- SCALE_16
- }
- val1 = __lasx_xvpickve2gr_w(out, 0);
- val2 = __lasx_xvpickve2gr_w(out, 4);
- val3 = __lasx_xvpickve2gr_w(out, 2);
- val4 = __lasx_xvpickve2gr_w(out, 6);
- for (; j < filterSize; j++) {
- val1 += ((int)srcPos1[j]) * filterStart1[j];
- val2 += ((int)srcPos2[j]) * filterStart2[j];
- val3 += ((int)srcPos3[j]) * filterStart3[j];
- val4 += ((int)srcPos4[j]) * filterStart4[j];
- }
- dst[0] = FFMIN(val1 >> sh, max);
- dst[1] = FFMIN(val2 >> sh, max);
- dst[2] = FFMIN(val3 >> sh, max);
- dst[3] = FFMIN(val4 >> sh, max);
- dst += 4;
- filterPos += 4;
- filter = filterStart4 + filterSize;
- }
- for (i = 0; i < res; i++) {
- int j, val = 0;
- const uint16_t *srcPos = src + filterPos[i];
- __m256i src0, filter0, out0;
- for (j = 0; j < filterlen; j += 8) {
- int dex = j << 1;
- src0 = __lasx_xvldx(srcPos, dex);
- filter0 = __lasx_xvldx(filter, dex);
- out0 = __lasx_xvdp2_w_hu_h(src0, filter0);
- out0 = __lasx_xvhaddw_d_w(out0, out0);
- out0 = __lasx_xvhaddw_q_d(out0, out0);
- val += __lasx_xvpickve2gr_w(out0, 0);
- }
- for (; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[i] = FFMIN(val >> sh, max);
- filter += filterSize;
- }
- } else {
- for (i = 0; i < dstW; i++) {
- int val = 0;
- const uint16_t *srcPos = src + filterPos[i];
- for (int j = 0; j < filterSize; j++) {
- val += ((int)srcPos[j]) * filter[j];
- }
- dst[i] = FFMIN(val >> sh, max);
- filter += filterSize;
- }
- }
- }
- #undef SCALE_8
- #undef SCALE_16
|