Source code
Revision control
Copy as Markdown
Other Tools
/*
* Loongson MMI optimizations for libjpeg-turbo
*
* Copyright (C) 2015, 2018-2019, D. R. Commander. All Rights Reserved.
* Copyright (C) 2016-2018, Loongson Technology Corporation Limited, BeiJing.
* All Rights Reserved.
* Authors: ZhuChen <zhuchen@loongson.cn>
* CaiWanwei <caiwanwei@loongson.cn>
* SunZhangzhi <sunzhangzhi-cq@loongson.cn>
* ZhangLixia <zhanglixia-hf@loongson.cn>
*
* Based on the x86 SIMD extension for IJG JPEG library
* Copyright (C) 1999-2006, MIYASAKA Masaru.
*
* This software is provided 'as-is', without any express or implied
* warranty. In no event will the authors be held liable for any damages
* arising from the use of this software.
*
* Permission is granted to anyone to use this software for any purpose,
* including commercial applications, and to alter it and redistribute it
* freely, subject to the following restrictions:
*
* 1. The origin of this software must not be misrepresented; you must not
* claim that you wrote the original software. If you use this software
* in a product, an acknowledgment in the product documentation would be
* appreciated but is not required.
* 2. Altered source versions must be plainly marked as such, and must not be
* misrepresented as being the original software.
* 3. This notice may not be removed or altered from any source distribution.
*/
/* CHROMA UPSAMPLING */
#include "jsimd_mmi.h"
enum const_index {
index_PW_ONE,
index_PW_TWO,
index_PW_THREE,
index_PW_SEVEN,
index_PW_EIGHT,
};
static uint64_t const_value[] = {
_uint64_set_pi16(1, 1, 1, 1),
_uint64_set_pi16(2, 2, 2, 2),
_uint64_set_pi16(3, 3, 3, 3),
_uint64_set_pi16(7, 7, 7, 7),
_uint64_set_pi16(8, 8, 8, 8),
};
#define PW_ONE get_const_value(index_PW_ONE)
#define PW_TWO get_const_value(index_PW_TWO)
#define PW_THREE get_const_value(index_PW_THREE)
#define PW_SEVEN get_const_value(index_PW_SEVEN)
#define PW_EIGHT get_const_value(index_PW_EIGHT)
#define PROCESS_ROW(row, wkoffset, bias1, bias2, shift) { \
__m64 samp123X, samp3XXX, samp1234, sampX012, samp_1012; \
__m64 sampXXX4, sampX456, samp3456, samp567X, samp7XXX, samp5678; \
__m64 outle, outhe, outlo, outho, outl, outh; \
\
samp123X = _mm_srli_si64(samp0123, 2 * BYTE_BIT); /* ( 1 2 3 -) */ \
sampXXX4 = _mm_slli_si64(samp4567, (SIZEOF_MMWORD - 2) * BYTE_BIT); /* ( - - - 4) */ \
samp3XXX = _mm_srli_si64(samp0123, (SIZEOF_MMWORD - 2) * BYTE_BIT); /* ( 3 - - -) */ \
sampX456 = _mm_slli_si64(samp4567, 2 * BYTE_BIT); /* ( - 4 5 6) */ \
\
samp1234 = _mm_or_si64(samp123X, sampXXX4); /* ( 1 2 3 4) */ \
samp3456 = _mm_or_si64(samp3XXX, sampX456); /* ( 3 4 5 6) */ \
\
sampX012 = _mm_slli_si64(samp0123, 2 * BYTE_BIT); /* ( - 0 1 2) */ \
samp567X = _mm_srli_si64(samp4567, 2 * BYTE_BIT); /* ( 5 6 7 -) */ \
samp7XXX = _mm_srli_si64(samp4567, (SIZEOF_MMWORD - 2) * BYTE_BIT); /* ( 7 - - -) */ \
\
samp_1012 = _mm_or_si64(sampX012, wk[row]); /* (-1 0 1 2) */ \
samp5678 = _mm_or_si64(samp567X, wk[row + wkoffset]); /* ( 5 6 7 8) */ \
\
wk[row] = samp7XXX; \
\
samp0123 = _mm_mullo_pi16(samp0123, PW_THREE); \
samp4567 = _mm_mullo_pi16(samp4567, PW_THREE); \
samp_1012 = _mm_add_pi16(samp_1012, bias1); \
samp3456 = _mm_add_pi16(samp3456, bias1); \
samp1234 = _mm_add_pi16(samp1234, bias2); \
samp5678 = _mm_add_pi16(samp5678, bias2); \
\
outle = _mm_add_pi16(samp_1012, samp0123); \
outhe = _mm_add_pi16(samp3456, samp4567); \
outle = _mm_srli_pi16(outle, shift); /* ( 0 2 4 6) */ \
outhe = _mm_srli_pi16(outhe, shift); /* ( 8 10 12 14) */ \
outlo = _mm_add_pi16(samp1234, samp0123); \
outho = _mm_add_pi16(samp5678, samp4567); \
outlo = _mm_srli_pi16(outlo, shift); /* ( 1 3 5 7) */ \
outho = _mm_srli_pi16(outho, shift); /* ( 9 11 13 15) */ \
\
outlo = _mm_slli_pi16(outlo, BYTE_BIT); \
outho = _mm_slli_pi16(outho, BYTE_BIT); \
outl = _mm_or_si64(outle, outlo); /* ( 0 1 2 3 4 5 6 7) */ \
outh = _mm_or_si64(outhe, outho); /* ( 8 9 10 11 12 13 14 15) */ \
\
_mm_store_si64((__m64 *)outptr##row, outl); \
_mm_store_si64((__m64 *)outptr##row + 1, outh); \
}
void jsimd_h2v2_fancy_upsample_mmi(int max_v_samp_factor,
JDIMENSION downsampled_width,
JSAMPARRAY input_data,
JSAMPARRAY *output_data_ptr)
{
JSAMPARRAY output_data = *output_data_ptr;
JSAMPROW inptr_1, inptr0, inptr1, outptr0, outptr1;
int inrow, outrow, incol, tmp, tmp1;
__m64 this_1l, this_1h, this_1, thiscolsum_1l, thiscolsum_1h;
__m64 this0l, this0h, this0;
__m64 this1l, this1h, this1, thiscolsum1l, thiscolsum1h;
__m64 next_1l, next_1h, next_1, nextcolsum_1l, nextcolsum_1h;
__m64 next0l, next0h, next0;
__m64 next1l, next1h, next1, nextcolsum1l, nextcolsum1h;
__m64 mask0 = 0.0, masklast, samp0123, samp4567, wk[4], zero = 0.0;
mask0 = _mm_cmpeq_pi8(mask0, mask0);
masklast = _mm_slli_si64(mask0, (SIZEOF_MMWORD - 2) * BYTE_BIT);
mask0 = _mm_srli_si64(mask0, (SIZEOF_MMWORD - 2) * BYTE_BIT);
for (inrow = 0, outrow = 0; outrow < max_v_samp_factor; inrow++) {
inptr_1 = input_data[inrow - 1];
inptr0 = input_data[inrow];
inptr1 = input_data[inrow + 1];
outptr0 = output_data[outrow++];
outptr1 = output_data[outrow++];
if (downsampled_width & 7) {
tmp = (downsampled_width - 1) * sizeof(JSAMPLE);
tmp1 = downsampled_width * sizeof(JSAMPLE);
asm(PTR_ADDU "$8, %3, %6\r\n"
"lb $9, ($8)\r\n"
PTR_ADDU "$8, %3, %7\r\n"
"sb $9, ($8)\r\n"
PTR_ADDU "$8, %4, %6\r\n"
"lb $9, ($8)\r\n"
PTR_ADDU "$8, %4, %7\r\n"
"sb $9, ($8)\r\n"
PTR_ADDU "$8, %5, %6\r\n"
"lb $9, ($8)\r\n"
PTR_ADDU "$8, %5, %7\r\n"
"sb $9, ($8)\r\n"
: "=m" (*inptr_1), "=m" (*inptr0), "=m" (*inptr1)
: "r" (inptr_1), "r" (inptr0), "r" (inptr1), "r" (tmp), "r" (tmp1)
: "$8", "$9"
);
}
/* process the first column block */
this0 = _mm_load_si64((__m64 *)inptr0); /* row[ 0][0] */
this_1 = _mm_load_si64((__m64 *)inptr_1); /* row[-1][0] */
this1 = _mm_load_si64((__m64 *)inptr1); /* row[ 1][0] */
this0l = _mm_unpacklo_pi8(this0, zero); /* row[ 0][0]( 0 1 2 3) */
this0h = _mm_unpackhi_pi8(this0, zero); /* row[ 0][0]( 4 5 6 7) */
this_1l = _mm_unpacklo_pi8(this_1, zero); /* row[-1][0]( 0 1 2 3) */
this_1h = _mm_unpackhi_pi8(this_1, zero); /* row[-1][0]( 4 5 6 7) */
this1l = _mm_unpacklo_pi8(this1, zero); /* row[+1][0]( 0 1 2 3) */
this1h = _mm_unpackhi_pi8(this1, zero); /* row[+1][0]( 4 5 6 7) */
this0l = _mm_mullo_pi16(this0l, PW_THREE);
this0h = _mm_mullo_pi16(this0h, PW_THREE);
thiscolsum_1l = _mm_add_pi16(this_1l, this0l); /* ( 0 1 2 3) */
thiscolsum_1h = _mm_add_pi16(this_1h, this0h); /* ( 4 5 6 7) */
thiscolsum1l = _mm_add_pi16(this0l, this1l); /* ( 0 1 2 3) */
thiscolsum1h = _mm_add_pi16(this0h, this1h); /* ( 4 5 6 7) */
/* temporarily save the intermediate data */
_mm_store_si64((__m64 *)outptr0, thiscolsum_1l);
_mm_store_si64((__m64 *)outptr0 + 1, thiscolsum_1h);
_mm_store_si64((__m64 *)outptr1, thiscolsum1l);
_mm_store_si64((__m64 *)outptr1 + 1, thiscolsum1h);
wk[0] = _mm_and_si64(thiscolsum_1l, mask0); /* ( 0 - - -) */
wk[1] = _mm_and_si64(thiscolsum1l, mask0); /* ( 0 - - -) */
for (incol = downsampled_width; incol > 0;
incol -= 8, inptr_1 += 8, inptr0 += 8, inptr1 += 8,
outptr0 += 16, outptr1 += 16) {
if (incol > 8) {
/* process the next column block */
next0 = _mm_load_si64((__m64 *)inptr0 + 1); /* row[ 0][1] */
next_1 = _mm_load_si64((__m64 *)inptr_1 + 1); /* row[-1][1] */
next1 = _mm_load_si64((__m64 *)inptr1 + 1); /* row[+1][1] */
next0l = _mm_unpacklo_pi8(next0, zero); /* row[ 0][1]( 0 1 2 3) */
next0h = _mm_unpackhi_pi8(next0, zero); /* row[ 0][1]( 4 5 6 7) */
next_1l = _mm_unpacklo_pi8(next_1, zero); /* row[-1][1]( 0 1 2 3) */
next_1h = _mm_unpackhi_pi8(next_1, zero); /* row[-1][1]( 4 5 6 7) */
next1l = _mm_unpacklo_pi8(next1, zero); /* row[+1][1]( 0 1 2 3) */
next1h = _mm_unpackhi_pi8(next1, zero); /* row[+1][1]( 4 5 6 7) */
next0l = _mm_mullo_pi16(next0l, PW_THREE);
next0h = _mm_mullo_pi16(next0h, PW_THREE);
nextcolsum_1l = _mm_add_pi16(next_1l, next0l); /* ( 0 1 2 3) */
nextcolsum_1h = _mm_add_pi16(next_1h, next0h); /* ( 4 5 6 7) */
nextcolsum1l = _mm_add_pi16(next0l, next1l); /* ( 0 1 2 3) */
nextcolsum1h = _mm_add_pi16(next0h, next1h); /* ( 4 5 6 7) */
/* temporarily save the intermediate data */
_mm_store_si64((__m64 *)outptr0 + 2, nextcolsum_1l);
_mm_store_si64((__m64 *)outptr0 + 3, nextcolsum_1h);
_mm_store_si64((__m64 *)outptr1 + 2, nextcolsum1l);
_mm_store_si64((__m64 *)outptr1 + 3, nextcolsum1h);
wk[2] = _mm_slli_si64(nextcolsum_1l, (SIZEOF_MMWORD - 2) * BYTE_BIT); /* ( - - - 0) */
wk[3] = _mm_slli_si64(nextcolsum1l, (SIZEOF_MMWORD - 2) * BYTE_BIT); /* ( - - - 0) */
} else {
__m64 tmp;
/* process the last column block */
tmp = _mm_load_si64((__m64 *)outptr0 + 1);
wk[2] = _mm_and_si64(masklast, tmp); /* ( - - - 7) */
tmp = _mm_load_si64((__m64 *)outptr1 + 1);
wk[3] = _mm_and_si64(masklast, tmp); /* ( - - - 7) */
}
/* process the upper row */
samp0123 = _mm_load_si64((__m64 *)outptr0); /* ( 0 1 2 3) */ \
samp4567 = _mm_load_si64((__m64 *)outptr0 + 1); /* ( 4 5 6 7) */ \
PROCESS_ROW(0, 2, PW_EIGHT, PW_SEVEN, 4)
/* process the lower row */
samp0123 = _mm_load_si64((__m64 *)outptr1); /* ( 0 1 2 3) */ \
samp4567 = _mm_load_si64((__m64 *)outptr1 + 1); /* ( 4 5 6 7) */ \
PROCESS_ROW(1, 2, PW_EIGHT, PW_SEVEN, 4)
}
}
}
void jsimd_h2v1_fancy_upsample_mmi(int max_v_samp_factor,
JDIMENSION downsampled_width,
JSAMPARRAY input_data,
JSAMPARRAY *output_data_ptr)
{
JSAMPARRAY output_data = *output_data_ptr;
JSAMPROW inptr0, outptr0;
int inrow, incol, tmp, tmp1;
__m64 thisl, this, nextl, next;
__m64 mask0 = 0.0, masklast, samp0123, samp4567, wk[2], zero = 0.0;
mask0 = _mm_cmpeq_pi8(mask0, mask0);
masklast = _mm_slli_si64(mask0, (SIZEOF_MMWORD - 2) * BYTE_BIT);
mask0 = _mm_srli_si64(mask0, (SIZEOF_MMWORD - 2) * BYTE_BIT);
for (inrow = 0; inrow < max_v_samp_factor; inrow++) {
inptr0 = input_data[inrow];
outptr0 = output_data[inrow];
if (downsampled_width & 7) {
tmp = (downsampled_width - 1) * sizeof(JSAMPLE);
tmp1 = downsampled_width * sizeof(JSAMPLE);
asm(PTR_ADDU "$8, %1, %2\r\n"
"lb $9, ($8)\r\n"
PTR_ADDU "$8, %1, %3\r\n"
"sb $9, ($8)\r\n"
: "=m" (*inptr0)
: "r" (inptr0), "r" (tmp), "r" (tmp1)
: "$8", "$9"
);
}
/* process the first column block */
this = _mm_load_si64((__m64 *)inptr0); /* row[ 0][0] */
thisl = _mm_unpacklo_pi8(this, zero); /* row[ 0][0]( 0 1 2 3) */
wk[0] = _mm_and_si64(thisl, mask0); /* ( 0 - - -) */
for (incol = downsampled_width; incol > 0;
incol -= 8, inptr0 += 8, outptr0 += 16) {
if (incol > 8) {
/* process the next column block */
next = _mm_load_si64((__m64 *)inptr0 + 1); /* row[ 0][1] */
nextl = _mm_unpacklo_pi8(next, zero); /* row[ 0][1]( 0 1 2 3) */
wk[1] = _mm_slli_si64(nextl, (SIZEOF_MMWORD - 2) * BYTE_BIT); /* ( - - - 0) */
} else {
__m64 thish;
/* process the last column block */
this = _mm_load_si64((__m64 *)inptr0); /* row[ 0][0] */
thish = _mm_unpackhi_pi8(this, zero); /* row[ 0][1]( 4 5 6 7) */
wk[1] = _mm_and_si64(masklast, thish); /* ( - - - 7) */
}
/* process the row */
this = _mm_load_si64((__m64 *)inptr0); /* row[ 0][0] */
samp0123 = _mm_unpacklo_pi8(this, zero); /* ( 0 1 2 3) */
samp4567 = _mm_unpackhi_pi8(this, zero); /* ( 4 5 6 7) */
PROCESS_ROW(0, 1, PW_ONE, PW_TWO, 2)
}
}
}