123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398 |
- #include "jsimd_mmi.h"
- #define CONST_BITS 13
- #define PASS1_BITS 2
- #define DESCALE_P1 (CONST_BITS - PASS1_BITS)
- #define DESCALE_P2 (CONST_BITS + PASS1_BITS)
- #define FIX_0_298 ((short)2446)
- #define FIX_0_390 ((short)3196)
- #define FIX_0_541 ((short)4433)
- #define FIX_0_765 ((short)6270)
- #define FIX_0_899 ((short)7373)
- #define FIX_1_175 ((short)9633)
- #define FIX_1_501 ((short)12299)
- #define FIX_1_847 ((short)15137)
- #define FIX_1_961 ((short)16069)
- #define FIX_2_053 ((short)16819)
- #define FIX_2_562 ((short)20995)
- #define FIX_3_072 ((short)25172)
- enum const_index {
- index_PW_F130_F054,
- index_PW_F054_MF130,
- index_PW_MF078_F117,
- index_PW_F117_F078,
- index_PW_MF060_MF089,
- index_PW_MF089_F060,
- index_PW_MF050_MF256,
- index_PW_MF256_F050,
- index_PD_DESCALE_P1,
- index_PD_DESCALE_P2,
- index_PW_DESCALE_P2X
- };
- static uint64_t const_value[] = {
- _uint64_set_pi16(FIX_0_541, (FIX_0_541 + FIX_0_765),
- FIX_0_541, (FIX_0_541 + FIX_0_765)),
- _uint64_set_pi16((FIX_0_541 - FIX_1_847), FIX_0_541,
- (FIX_0_541 - FIX_1_847), FIX_0_541),
- _uint64_set_pi16(FIX_1_175, (FIX_1_175 - FIX_1_961),
- FIX_1_175, (FIX_1_175 - FIX_1_961)),
- _uint64_set_pi16((FIX_1_175 - FIX_0_390), FIX_1_175,
- (FIX_1_175 - FIX_0_390), FIX_1_175),
- _uint64_set_pi16(-FIX_0_899, (FIX_0_298 - FIX_0_899),
- -FIX_0_899, (FIX_0_298 - FIX_0_899)),
- _uint64_set_pi16((FIX_1_501 - FIX_0_899), -FIX_0_899,
- (FIX_1_501 - FIX_0_899), -FIX_0_899),
- _uint64_set_pi16(-FIX_2_562, (FIX_2_053 - FIX_2_562),
- -FIX_2_562, (FIX_2_053 - FIX_2_562)),
- _uint64_set_pi16((FIX_3_072 - FIX_2_562), -FIX_2_562,
- (FIX_3_072 - FIX_2_562), -FIX_2_562),
- _uint64_set_pi32((1 << (DESCALE_P1 - 1)), (1 << (DESCALE_P1 - 1))),
- _uint64_set_pi32((1 << (DESCALE_P2 - 1)), (1 << (DESCALE_P2 - 1))),
- _uint64_set_pi16((1 << (PASS1_BITS - 1)), (1 << (PASS1_BITS - 1)),
- (1 << (PASS1_BITS - 1)), (1 << (PASS1_BITS - 1)))
- };
- #define PW_F130_F054 get_const_value(index_PW_F130_F054)
- #define PW_F054_MF130 get_const_value(index_PW_F054_MF130)
- #define PW_MF078_F117 get_const_value(index_PW_MF078_F117)
- #define PW_F117_F078 get_const_value(index_PW_F117_F078)
- #define PW_MF060_MF089 get_const_value(index_PW_MF060_MF089)
- #define PW_MF089_F060 get_const_value(index_PW_MF089_F060)
- #define PW_MF050_MF256 get_const_value(index_PW_MF050_MF256)
- #define PW_MF256_F050 get_const_value(index_PW_MF256_F050)
- #define PD_DESCALE_P1 get_const_value(index_PD_DESCALE_P1)
- #define PD_DESCALE_P2 get_const_value(index_PD_DESCALE_P2)
- #define PW_DESCALE_P2X get_const_value(index_PW_DESCALE_P2X)
- #define DO_FDCT_COMMON(PASS) { \
- __m64 tmp1312l, tmp1312h, tmp47l, tmp47h, tmp4l, tmp4h, tmp7l, tmp7h; \
- __m64 tmp56l, tmp56h, tmp5l, tmp5h, tmp6l, tmp6h; \
- __m64 out1l, out1h, out2l, out2h, out3l, out3h; \
- __m64 out5l, out5h, out6l, out6h, out7l, out7h; \
- __m64 z34l, z34h, z3l, z3h, z4l, z4h, z3, z4; \
- \
-
- \
- \
- tmp1312l = _mm_unpacklo_pi16(tmp13, tmp12); \
- tmp1312h = _mm_unpackhi_pi16(tmp13, tmp12); \
- \
- out2l = _mm_madd_pi16(tmp1312l, PW_F130_F054); \
- out2h = _mm_madd_pi16(tmp1312h, PW_F130_F054); \
- out6l = _mm_madd_pi16(tmp1312l, PW_F054_MF130); \
- out6h = _mm_madd_pi16(tmp1312h, PW_F054_MF130); \
- \
- out2l = _mm_add_pi32(out2l, PD_DESCALE_P##PASS); \
- out2h = _mm_add_pi32(out2h, PD_DESCALE_P##PASS); \
- out2l = _mm_srai_pi32(out2l, DESCALE_P##PASS); \
- out2h = _mm_srai_pi32(out2h, DESCALE_P##PASS); \
- \
- out6l = _mm_add_pi32(out6l, PD_DESCALE_P##PASS); \
- out6h = _mm_add_pi32(out6h, PD_DESCALE_P##PASS); \
- out6l = _mm_srai_pi32(out6l, DESCALE_P##PASS); \
- out6h = _mm_srai_pi32(out6h, DESCALE_P##PASS); \
- \
- out2 = _mm_packs_pi32(out2l, out2h); \
- out6 = _mm_packs_pi32(out6l, out6h); \
- \
- \
- \
- z3 = _mm_add_pi16(tmp4, tmp6); \
- z4 = _mm_add_pi16(tmp5, tmp7); \
- \
-
- \
- \
- z34l = _mm_unpacklo_pi16(z3, z4); \
- z34h = _mm_unpackhi_pi16(z3, z4); \
- z3l = _mm_madd_pi16(z34l, PW_MF078_F117); \
- z3h = _mm_madd_pi16(z34h, PW_MF078_F117); \
- z4l = _mm_madd_pi16(z34l, PW_F117_F078); \
- z4h = _mm_madd_pi16(z34h, PW_F117_F078); \
- \
-
- \
- \
- tmp47l = _mm_unpacklo_pi16(tmp4, tmp7); \
- tmp47h = _mm_unpackhi_pi16(tmp4, tmp7); \
- \
- tmp4l = _mm_madd_pi16(tmp47l, PW_MF060_MF089); \
- tmp4h = _mm_madd_pi16(tmp47h, PW_MF060_MF089); \
- tmp7l = _mm_madd_pi16(tmp47l, PW_MF089_F060); \
- tmp7h = _mm_madd_pi16(tmp47h, PW_MF089_F060); \
- \
- out7l = _mm_add_pi32(tmp4l, z3l); \
- out7h = _mm_add_pi32(tmp4h, z3h); \
- out1l = _mm_add_pi32(tmp7l, z4l); \
- out1h = _mm_add_pi32(tmp7h, z4h); \
- \
- out7l = _mm_add_pi32(out7l, PD_DESCALE_P##PASS); \
- out7h = _mm_add_pi32(out7h, PD_DESCALE_P##PASS); \
- out7l = _mm_srai_pi32(out7l, DESCALE_P##PASS); \
- out7h = _mm_srai_pi32(out7h, DESCALE_P##PASS); \
- \
- out1l = _mm_add_pi32(out1l, PD_DESCALE_P##PASS); \
- out1h = _mm_add_pi32(out1h, PD_DESCALE_P##PASS); \
- out1l = _mm_srai_pi32(out1l, DESCALE_P##PASS); \
- out1h = _mm_srai_pi32(out1h, DESCALE_P##PASS); \
- \
- out7 = _mm_packs_pi32(out7l, out7h); \
- out1 = _mm_packs_pi32(out1l, out1h); \
- \
- tmp56l = _mm_unpacklo_pi16(tmp5, tmp6); \
- tmp56h = _mm_unpackhi_pi16(tmp5, tmp6); \
- \
- tmp5l = _mm_madd_pi16(tmp56l, PW_MF050_MF256); \
- tmp5h = _mm_madd_pi16(tmp56h, PW_MF050_MF256); \
- tmp6l = _mm_madd_pi16(tmp56l, PW_MF256_F050); \
- tmp6h = _mm_madd_pi16(tmp56h, PW_MF256_F050); \
- \
- out5l = _mm_add_pi32(tmp5l, z4l); \
- out5h = _mm_add_pi32(tmp5h, z4h); \
- out3l = _mm_add_pi32(tmp6l, z3l); \
- out3h = _mm_add_pi32(tmp6h, z3h); \
- \
- out5l = _mm_add_pi32(out5l, PD_DESCALE_P##PASS); \
- out5h = _mm_add_pi32(out5h, PD_DESCALE_P##PASS); \
- out5l = _mm_srai_pi32(out5l, DESCALE_P##PASS); \
- out5h = _mm_srai_pi32(out5h, DESCALE_P##PASS); \
- \
- out3l = _mm_add_pi32(out3l, PD_DESCALE_P##PASS); \
- out3h = _mm_add_pi32(out3h, PD_DESCALE_P##PASS); \
- out3l = _mm_srai_pi32(out3l, DESCALE_P##PASS); \
- out3h = _mm_srai_pi32(out3h, DESCALE_P##PASS); \
- \
- out5 = _mm_packs_pi32(out5l, out5h); \
- out3 = _mm_packs_pi32(out3l, out3h); \
- }
- #define DO_FDCT_PASS1() { \
- __m64 row0l, row0h, row1l, row1h, row2l, row2h, row3l, row3h; \
- __m64 row01a, row01b, row01c, row01d, row23a, row23b, row23c, row23d; \
- __m64 col0, col1, col2, col3, col4, col5, col6, col7; \
- __m64 tmp10, tmp11; \
- \
- row0l = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 0]); \
- row0h = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 0 + 4]); \
- row1l = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 1]); \
- row1h = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 1 + 4]); \
- row2l = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 2]); \
- row2h = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 2 + 4]); \
- row3l = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 3]); \
- row3h = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 3 + 4]); \
- \
- \
- \
- row23a = _mm_unpacklo_pi16(row2l, row3l); \
- row23b = _mm_unpackhi_pi16(row2l, row3l); \
- row23c = _mm_unpacklo_pi16(row2h, row3h); \
- row23d = _mm_unpackhi_pi16(row2h, row3h); \
- \
- row01a = _mm_unpacklo_pi16(row0l, row1l); \
- row01b = _mm_unpackhi_pi16(row0l, row1l); \
- row01c = _mm_unpacklo_pi16(row0h, row1h); \
- row01d = _mm_unpackhi_pi16(row0h, row1h); \
- \
- col0 = _mm_unpacklo_pi32(row01a, row23a); \
- col1 = _mm_unpackhi_pi32(row01a, row23a); \
- col6 = _mm_unpacklo_pi32(row01d, row23d); \
- col7 = _mm_unpackhi_pi32(row01d, row23d); \
- \
- tmp6 = _mm_sub_pi16(col1, col6); \
- tmp7 = _mm_sub_pi16(col0, col7); \
- tmp1 = _mm_add_pi16(col1, col6); \
- tmp0 = _mm_add_pi16(col0, col7); \
- \
- col2 = _mm_unpacklo_pi32(row01b, row23b); \
- col3 = _mm_unpackhi_pi32(row01b, row23b); \
- col4 = _mm_unpacklo_pi32(row01c, row23c); \
- col5 = _mm_unpackhi_pi32(row01c, row23c); \
- \
- tmp3 = _mm_add_pi16(col3, col4); \
- tmp2 = _mm_add_pi16(col2, col5); \
- tmp4 = _mm_sub_pi16(col3, col4); \
- tmp5 = _mm_sub_pi16(col2, col5); \
- \
- \
- \
- tmp10 = _mm_add_pi16(tmp0, tmp3); \
- tmp13 = _mm_sub_pi16(tmp0, tmp3); \
- tmp11 = _mm_add_pi16(tmp1, tmp2); \
- tmp12 = _mm_sub_pi16(tmp1, tmp2); \
- \
- out0 = _mm_add_pi16(tmp10, tmp11); \
- out4 = _mm_sub_pi16(tmp10, tmp11); \
- out0 = _mm_slli_pi16(out0, PASS1_BITS); \
- out4 = _mm_slli_pi16(out4, PASS1_BITS); \
- \
- DO_FDCT_COMMON(1) \
- \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 0], out0); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 0 + 4], out4); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 1], out1); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 1 + 4], out5); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 2], out2); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 2 + 4], out6); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 3], out3); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 3 + 4], out7); \
- }
- #define DO_FDCT_PASS2() { \
- __m64 col0l, col0h, col1l, col1h, col2l, col2h, col3l, col3h; \
- __m64 col01a, col01b, col01c, col01d, col23a, col23b, col23c, col23d; \
- __m64 row0, row1, row2, row3, row4, row5, row6, row7; \
- __m64 tmp10, tmp11; \
- \
- col0l = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 0]); \
- col1l = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 1]); \
- col2l = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 2]); \
- col3l = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 3]); \
- col0h = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 4]); \
- col1h = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 5]); \
- col2h = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 6]); \
- col3h = _mm_load_si64((__m64 *)&dataptr[DCTSIZE * 7]); \
- \
- \
- \
- col23a = _mm_unpacklo_pi16(col2l, col3l); \
- col23b = _mm_unpackhi_pi16(col2l, col3l); \
- col23c = _mm_unpacklo_pi16(col2h, col3h); \
- col23d = _mm_unpackhi_pi16(col2h, col3h); \
- \
- col01a = _mm_unpacklo_pi16(col0l, col1l); \
- col01b = _mm_unpackhi_pi16(col0l, col1l); \
- col01c = _mm_unpacklo_pi16(col0h, col1h); \
- col01d = _mm_unpackhi_pi16(col0h, col1h); \
- \
- row0 = _mm_unpacklo_pi32(col01a, col23a); \
- row1 = _mm_unpackhi_pi32(col01a, col23a); \
- row6 = _mm_unpacklo_pi32(col01d, col23d); \
- row7 = _mm_unpackhi_pi32(col01d, col23d); \
- \
- tmp6 = _mm_sub_pi16(row1, row6); \
- tmp7 = _mm_sub_pi16(row0, row7); \
- tmp1 = _mm_add_pi16(row1, row6); \
- tmp0 = _mm_add_pi16(row0, row7); \
- \
- row2 = _mm_unpacklo_pi32(col01b, col23b); \
- row3 = _mm_unpackhi_pi32(col01b, col23b); \
- row4 = _mm_unpacklo_pi32(col01c, col23c); \
- row5 = _mm_unpackhi_pi32(col01c, col23c); \
- \
- tmp3 = _mm_add_pi16(row3, row4); \
- tmp2 = _mm_add_pi16(row2, row5); \
- tmp4 = _mm_sub_pi16(row3, row4); \
- tmp5 = _mm_sub_pi16(row2, row5); \
- \
- \
- \
- tmp10 = _mm_add_pi16(tmp0, tmp3); \
- tmp13 = _mm_sub_pi16(tmp0, tmp3); \
- tmp11 = _mm_add_pi16(tmp1, tmp2); \
- tmp12 = _mm_sub_pi16(tmp1, tmp2); \
- \
- out0 = _mm_add_pi16(tmp10, tmp11); \
- out4 = _mm_sub_pi16(tmp10, tmp11); \
- \
- out0 = _mm_add_pi16(out0, PW_DESCALE_P2X); \
- out4 = _mm_add_pi16(out4, PW_DESCALE_P2X); \
- out0 = _mm_srai_pi16(out0, PASS1_BITS); \
- out4 = _mm_srai_pi16(out4, PASS1_BITS); \
- \
- DO_FDCT_COMMON(2) \
- \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 0], out0); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 1], out1); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 2], out2); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 3], out3); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 4], out4); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 5], out5); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 6], out6); \
- _mm_store_si64((__m64 *)&dataptr[DCTSIZE * 7], out7); \
- }
- void jsimd_fdct_islow_mmi(DCTELEM *data)
- {
- __m64 tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7;
- __m64 out0, out1, out2, out3, out4, out5, out6, out7;
- __m64 tmp12, tmp13;
- DCTELEM *dataptr = data;
-
- DO_FDCT_PASS1()
- dataptr += DCTSIZE * 4;
- DO_FDCT_PASS1()
-
- dataptr = data;
- DO_FDCT_PASS2()
- dataptr += 4;
- DO_FDCT_PASS2()
- }
|