python-pillow/Pillow
1
1
Fork 0
mirror of https://github.com/python-pillow/Pillow.git synced 2025-08-20 20:24:45 +03:00
Code Issues Packages Projects Releases Wiki Activity

SIMD ColorLUT. 16bit arithmetic. Access violation fixed

Browse Source
This commit is contained in:
Alexander 2020-01-22 13:36:22 +03:00 committed by Alexander Karpinsky
parent 085b72935b
commit 1e70975dc1
1 changed files with 331 additions and 250 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

577
src/libImaging/ColorLUT.c
View File

@ -7,13 +7,118 @@
#define PRECISION_BITS (16 - 8 - 2)
#define PRECISION_ROUNDING (1 << (PRECISION_BITS - 1))
/* 8 — scales are multiplied on byte.
/* 16 — UINT16 capacity
6 — max index in the table
(max size is 65, but index 64 is not reachable) */
#define SCALE_BITS (32 - 8 - 6)
#define SCALE_MASK ((1 << SCALE_BITS) - 1)
(max size is 65, but index 64 is not reachable)
7 — that much bits we can save if divide the value by 255. */
#define SCALE_BITS (16 - 6 + 7)
#define SCALE_MASK ((1<<SCALE_BITS) - 1)
#define SHIFT_BITS (16 - 1)
/* Number of bits in the index tail which is used as a shift
between two table values. Should be >= 9, <= 14. */
#define SHIFT_BITS (16 - 7)
__m128i static inline
mm_lut_pixel(INT16* table, int size2D_shift, int size3D_shift,
int idx, __m128i shift, __m128i shuffle)
{
__m128i leftleft, leftright, rightleft, rightright;
__m128i source, left, right;
__m128i shift1D = _mm_shuffle_epi32(shift, 0x00);
__m128i shift2D = _mm_shuffle_epi32(shift, 0x55);
__m128i shift3D = _mm_shuffle_epi32(shift, 0xaa);
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + 0]), shuffle);
leftleft = _mm_srai_epi32(_mm_madd_epi16(
source, shift1D), SHIFT_BITS);
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + size2D_shift]), shuffle);
leftright = _mm_slli_epi32(_mm_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + size3D_shift]), shuffle);
rightleft = _mm_srai_epi32(_mm_madd_epi16(
source, shift1D), SHIFT_BITS);
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + size3D_shift + size2D_shift]), shuffle);
rightright = _mm_slli_epi32(_mm_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
left = _mm_srai_epi32(_mm_madd_epi16(
_mm_blend_epi16(leftleft, leftright, 0xaa), shift2D),
SHIFT_BITS);
right = _mm_slli_epi32(_mm_madd_epi16(
_mm_blend_epi16(rightleft, rightright, 0xaa), shift2D),
16 - SHIFT_BITS);
return _mm_srai_epi32(_mm_madd_epi16(
_mm_blend_epi16(left, right, 0xaa), shift3D),
SHIFT_BITS);
}
#if defined(__AVX2__)
__m256i static inline
mm256_lut_pixel(INT16* table, int size2D_shift, int size3D_shift,
int idx1, int idx2, __m256i shift, __m256i shuffle)
{
__m256i leftleft, leftright, rightleft, rightright;
__m256i source, left, right;
__m256i shift1D = _mm256_shuffle_epi32(shift, 0x00);
__m256i shift2D = _mm256_shuffle_epi32(shift, 0x55);
__m256i shift3D = _mm256_shuffle_epi32(shift, 0xaa);
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + 0])),
_mm_loadu_si128((__m128i *) &table[idx2 + 0]), 1),
shuffle);
leftleft = _mm256_srai_epi32(_mm256_madd_epi16(
source, shift1D), SHIFT_BITS);
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + size2D_shift])),
_mm_loadu_si128((__m128i *) &table[idx2 + size2D_shift]), 1),
shuffle);
leftright = _mm256_slli_epi32(_mm256_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + size3D_shift])),
_mm_loadu_si128((__m128i *) &table[idx2 + size3D_shift]), 1),
shuffle);
rightleft = _mm256_srai_epi32(_mm256_madd_epi16(
source, shift1D), SHIFT_BITS);
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + size3D_shift + size2D_shift])),
_mm_loadu_si128((__m128i *) &table[idx2 + size3D_shift + size2D_shift]), 1),
shuffle);
rightright = _mm256_slli_epi32(_mm256_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
left = _mm256_srai_epi32(_mm256_madd_epi16(
_mm256_blend_epi16(leftleft, leftright, 0xaa), shift2D),
SHIFT_BITS);
right = _mm256_slli_epi32(_mm256_madd_epi16(
_mm256_blend_epi16(rightleft, rightright, 0xaa), shift2D),
16 - SHIFT_BITS);
return _mm256_srai_epi32(_mm256_madd_epi16(
_mm256_blend_epi16(left, right, 0xaa), shift3D),
SHIFT_BITS);
}
#endif
/*
@ -51,28 +156,46 @@ ImagingColorLUT3D_linear(
With this compensation we never hit the upper cells
but this also doesn't introduce any noticeable difference. */
int y, size1D_2D = size1D * size2D;
int size2D_shift = size1D * table_channels;
int size3D_shift = size1D_2D * table_channels;
ImagingSectionCookie cookie;
__m128i scale = _mm_set_epi32(0,
(size3D - 1) / 255.0 * (1<<SCALE_BITS),
(size2D - 1) / 255.0 * (1<<SCALE_BITS),
(size1D - 1) / 255.0 * (1<<SCALE_BITS));
__m128i scale_mask = _mm_set1_epi32(SCALE_MASK);
__m128i index_mul = _mm_set_epi32(
__m128i scale = _mm_set_epi16(
0,
(int) ((size3D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size2D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size1D - 1) / 255.0 * (1<<SCALE_BITS)),
0,
(int) ((size3D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size2D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size1D - 1) / 255.0 * (1<<SCALE_BITS)));
__m128i scale_mask = _mm_set1_epi16(SCALE_MASK >> 8);
__m128i index_mul = _mm_set_epi16(
0, size1D_2D*table_channels, size1D*table_channels, table_channels,
0, size1D_2D*table_channels, size1D*table_channels, table_channels);
__m128i shuffle3 = _mm_set_epi8(-1,-1, -1,-1, 11,10, 5,4, 9,8, 3,2, 7,6, 1,0);
__m128i shuffle4 = _mm_set_epi8(15,14, 7,6, 13,12, 5,4, 11,10, 3,2, 9,8, 1,0);
#if defined(__AVX2__)
__m256i scale256 = _mm256_set_epi32(
__m256i scale256 = _mm256_set_epi16(
0,
(size3D - 1) / 255.0 * (1<<SCALE_BITS),
(size2D - 1) / 255.0 * (1<<SCALE_BITS),
(size1D - 1) / 255.0 * (1<<SCALE_BITS),
(int) ((size3D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size2D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size1D - 1) / 255.0 * (1<<SCALE_BITS)),
0,
(size3D - 1) / 255.0 * (1<<SCALE_BITS),
(size2D - 1) / 255.0 * (1<<SCALE_BITS),
(size1D - 1) / 255.0 * (1<<SCALE_BITS));
__m256i scale_mask256 = _mm256_set1_epi32(SCALE_MASK);
__m256i index_mul256 = _mm256_set_epi32(
(int) ((size3D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size2D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size1D - 1) / 255.0 * (1<<SCALE_BITS)),
0,
(int) ((size3D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size2D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size1D - 1) / 255.0 * (1<<SCALE_BITS)),
0,
(int) ((size3D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size2D - 1) / 255.0 * (1<<SCALE_BITS)),
(int) ((size1D - 1) / 255.0 * (1<<SCALE_BITS)));
__m256i scale_mask256 = _mm256_set1_epi16(SCALE_MASK >> 8);
__m256i index_mul256 = _mm256_set_epi16(
0, size1D_2D*table_channels, size1D*table_channels, table_channels,
0, size1D_2D*table_channels, size1D*table_channels, table_channels,
0, size1D_2D*table_channels, size1D*table_channels, table_channels,
0, size1D_2D*table_channels, size1D*table_channels, table_channels);
__m256i shuffle3_256 = _mm256_set_epi8(
@ -102,268 +225,226 @@ ImagingColorLUT3D_linear(
for (y = 0; y < imOut->ysize; y++) {
UINT32* rowIn = (UINT32 *)imIn->image[y];
UINT32* rowOut = (UINT32 *)imOut->image[y];
UINT8* rowIn8 = (UINT8 *)imIn->image[y];
UINT8* rowOut8 = (UINT8 *)imOut->image[y];
int x = 0;
#if defined(__AVX2__)
{
__m256i index = _mm256_mullo_epi32(scale256, mm256_cvtepu8_epi32(&rowIn[x]));
__m256i idxs = _mm256_hadd_epi32(_mm256_hadd_epi32(
_mm256_madd_epi16(index_mul256, _mm256_srli_epi32(index, SCALE_BITS)),
_mm256_setzero_si256()), _mm256_setzero_si256());
int idx1 = _mm_cvtsi128_si32(_mm256_castsi256_si128(idxs));
int idx2 = _mm256_extract_epi32(idxs, 4);
// This makes sense if 12 or more pixels remain (two loops)
if (x < imOut->xsize - 11) {
__m128i source = _mm_loadu_si128((__m128i *) &rowIn[x]);
// scale up to 16 bits, but scale * 255 * 256 up to 31 bits
// bi, gi and ri - 6 bits index
// rs, rs and rs - 9 bits shift
// 00 bi3.bs3 gi3.gs3 ri3.rs3 00 bi2.bs2 gi2.gs2 ri2.rs2
// 00 bi1.bs1 gi1.gs1 ri1.rs1 00 bi0.bs0 gi0.gs0 ri0.rs0
__m256i index = _mm256_mulhi_epu16(scale256,
_mm256_slli_epi16(_mm256_cvtepu8_epi16(source), 8));
// 0000 0000 idx3 idx2
// 0000 0000 idx1 idx0
__m256i index_src = _mm256_hadd_epi32(
_mm256_madd_epi16(index_mul256, _mm256_srli_epi16(index, SHIFT_BITS)),
_mm256_setzero_si256());
for (; x < imOut->xsize - 1; x += 2) {
__m256i next_index = _mm256_mullo_epi32(scale256, mm256_cvtepu8_epi32(&rowIn[x + 2]));
__m256i next_idxs = _mm256_hadd_epi32(_mm256_hadd_epi32(
_mm256_madd_epi16(index_mul256, _mm256_srli_epi32(next_index, SCALE_BITS)),
_mm256_setzero_si256()), _mm256_setzero_si256());
int next_idx1 = _mm_cvtsi128_si32(_mm256_castsi256_si128(next_idxs));
int next_idx2 = _mm256_extract_epi32(next_idxs, 4);
for (; x < imOut->xsize - 7; x += 4) {
__m128i next_source = _mm_loadu_si128((__m128i *) &rowIn[x + 4]);
// scale up to 16 bits, but scale * 255 * 256 up to 31 bits
// bi, gi and ri - 6 bits index
// rs, rs and rs - 9 bits shift
// 00 bi3.bs3 gi3.gs3 ri3.rs3 00 bi2.bs2 gi2.gs2 ri2.rs2
// 00 bi1.bs1 gi1.gs1 ri1.rs1 00 bi0.bs0 gi0.gs0 ri0.rs0
__m256i next_index = _mm256_mulhi_epu16(scale256,
_mm256_slli_epi16(_mm256_cvtepu8_epi16(next_source), 8));
// 0000 0000 idx3 idx2
// 0000 0000 idx1 idx0
__m256i next_index_src = _mm256_hadd_epi32(
_mm256_madd_epi16(index_mul256, _mm256_srli_epi16(next_index, SHIFT_BITS)),
_mm256_setzero_si256());
__m256i shift = _mm256_srli_epi32(
_mm256_and_si256(scale_mask256, index), (SCALE_BITS - SHIFT_BITS));
int idx0 = _mm_cvtsi128_si32(_mm256_castsi256_si128(index_src));
int idx1 = _mm256_extract_epi32(index_src, 1);
int idx2 = _mm256_extract_epi32(index_src, 4);
int idx3 = _mm256_extract_epi32(index_src, 5);
__m256i shift1D, shift2D, shift3D;
__m256i source, left, right, result;
__m256i leftleft, leftright, rightleft, rightright;
// 00 0.bs3 0.gs3 0.rs3 00 0.bs2 0.gs2 0.rs2
// 00 0.bs1 0.gs1 0.rs1 00 0.bs0 0.gs0 0.rs0
__m256i shift = _mm256_and_si256(index, scale_mask256);
// 11 1-bs3 1-gs3 1-rs3 11 1-bs2 1-gs2 1-rs2
// 11 1-bs1 1-gs1 1-rs1 11 1-bs0 1-gs0 1-rs0
__m256i inv_shift = _mm256_sub_epi16(_mm256_set1_epi16((1<<SHIFT_BITS)), shift);
shift = _mm256_or_si256(
_mm256_sub_epi32(_mm256_set1_epi32((1<<SHIFT_BITS)-1), shift),
_mm256_slli_epi32(shift, 16));
// 00 11 bs2 1-bs2 gs2 1-gs2 rs2 1-rs2
// 00 11 bs0 1-bs0 gs0 1-gs0 rs0 1-rs0
__m256i shift0 = _mm256_unpacklo_epi16(inv_shift, shift);
shift1D = _mm256_shuffle_epi32(shift, 0x00);
shift2D = _mm256_shuffle_epi32(shift, 0x55);
shift3D = _mm256_shuffle_epi32(shift, 0xaa);
// 00 11 bs3 1-bs3 gs3 1-gs3 rs3 1-rs3
// 00 11 bs1 1-bs1 gs1 1-gs1 rs1 1-rs1
__m256i shift1 = _mm256_unpackhi_epi16(inv_shift, shift);
if (table_channels == 3) {
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + 0])),
_mm_loadu_si128((__m128i *) &table[idx2 + 0]), 1),
shuffle3_256);
leftleft = _mm256_srai_epi32(_mm256_madd_epi16(
source, shift1D), SHIFT_BITS);
if (table_channels == 3) {
__m128i dest;
// a2 b2 g2 r2 a0 b0 g0 r0
__m256i result0 = mm256_lut_pixel(table, size2D_shift, size3D_shift,
idx0, idx2, shift0, shuffle3_256);
// a3 b3 g3 r3 a1 b1 g1 r1
__m256i result1 = mm256_lut_pixel(table, size2D_shift, size3D_shift,
idx1, idx3, shift1, shuffle3_256);
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + size1D*3])),
_mm_loadu_si128((__m128i *) &table[idx2 + size1D*3]), 1),
shuffle3_256);
leftright = _mm256_slli_epi32(_mm256_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
// a3 b3 g3 r3 a2 b2 g2 r2
// a1 b1 g1 r1 a0 b0 g0 r0
result0 = _mm256_packs_epi32(result0, result1);
result0 = _mm256_srai_epi16(
_mm256_add_epi16(result0, _mm256_set1_epi16(PRECISION_ROUNDING)),
PRECISION_BITS);
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + size1D_2D*3])),
_mm_loadu_si128((__m128i *) &table[idx2 + size1D_2D*3]), 1),
shuffle3_256);
rightleft = _mm256_srai_epi32(_mm256_madd_epi16(
source, shift1D), SHIFT_BITS);
// a3 b3 g3 r3 a2 b2 g2 r2 a1 b1 g1 r1 a0 b0 g0 r0
dest = _mm_packus_epi16(
_mm256_castsi256_si128(result0),
_mm256_extracti128_si256(result0, 1));
dest = _mm_blendv_epi8(dest, source,
_mm_set_epi8(-1, 0, 0, 0, -1, 0, 0, 0, -1, 0, 0, 0, -1, 0, 0, 0));
_mm_storeu_si128((__m128i*) &rowOut[x], dest);
}
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + size1D_2D*3 + size1D*3])),
_mm_loadu_si128((__m128i *) &table[idx2 + size1D_2D*3 + size1D*3]), 1),
shuffle3_256);
rightright = _mm256_slli_epi32(_mm256_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
if (table_channels == 4) {
__m128i dest;
__m256i result0 = mm256_lut_pixel(table, size2D_shift, size3D_shift,
idx0, idx2, shift0, shuffle4_256);
__m256i result1 = mm256_lut_pixel(table, size2D_shift, size3D_shift,
idx1, idx3, shift1, shuffle4_256);
left = _mm256_srai_epi32(_mm256_madd_epi16(
_mm256_blend_epi16(leftleft, leftright, 0xaa), shift2D),
SHIFT_BITS);
result0 = _mm256_packs_epi32(result0, result1);
result0 = _mm256_srai_epi16(
_mm256_add_epi16(result0, _mm256_set1_epi16(PRECISION_ROUNDING)),
PRECISION_BITS);
right = _mm256_slli_epi32(_mm256_madd_epi16(
_mm256_blend_epi16(rightleft, rightright, 0xaa), shift2D),
16 - SHIFT_BITS);
result = _mm256_madd_epi16(
_mm256_blend_epi16(left, right, 0xaa), shift3D);
result = _mm256_srai_epi32(_mm256_add_epi32(
_mm256_set1_epi32(PRECISION_ROUNDING<<SHIFT_BITS), result),
PRECISION_BITS + SHIFT_BITS);
result = _mm256_packs_epi32(result, result);
result = _mm256_packus_epi16(result, result);
rowOut[x + 0] = _mm_cvtsi128_si32(_mm256_castsi256_si128(result));
rowOut[x + 1] = _mm256_extract_epi32(result, 4);
rowOut8[x*4 + 3] = rowIn8[x*4 + 3];
rowOut8[x*4 + 7] = rowIn8[x*4 + 7];
dest = _mm_packus_epi16(
_mm256_castsi256_si128(result0),
_mm256_extracti128_si256(result0, 1));
_mm_storeu_si128((__m128i*) &rowOut[x], dest);
}
source = next_source;
index = next_index;
index_src = next_index_src;
}
if (table_channels == 4) {
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + 0])),
_mm_loadu_si128((__m128i *) &table[idx2 + 0]), 1),
shuffle4_256);
leftleft = _mm256_srai_epi32(_mm256_madd_epi16(
source, shift1D), SHIFT_BITS);
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + size1D*4])),
_mm_loadu_si128((__m128i *) &table[idx2 + size1D*4]), 1),
shuffle4_256);
leftright = _mm256_slli_epi32(_mm256_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + size1D_2D*4])),
_mm_loadu_si128((__m128i *) &table[idx2 + size1D_2D*4]), 1),
shuffle4_256);
rightleft = _mm256_srai_epi32(_mm256_madd_epi16(
source, shift1D), SHIFT_BITS);
source = _mm256_shuffle_epi8(
_mm256_inserti128_si256(_mm256_castsi128_si256(
_mm_loadu_si128((__m128i *) &table[idx1 + size1D_2D*4 + size1D*4])),
_mm_loadu_si128((__m128i *) &table[idx2 + size1D_2D*4 + size1D*4]), 1),
shuffle4_256);
rightright = _mm256_slli_epi32(_mm256_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
left = _mm256_srai_epi32(_mm256_madd_epi16(
_mm256_blend_epi16(leftleft, leftright, 0xaa), shift2D),
SHIFT_BITS);
right = _mm256_slli_epi32(_mm256_madd_epi16(
_mm256_blend_epi16(rightleft, rightright, 0xaa), shift2D),
16 - SHIFT_BITS);
result = _mm256_madd_epi16(
_mm256_blend_epi16(left, right, 0xaa), shift3D);
result = _mm256_srai_epi32(_mm256_add_epi32(
_mm256_set1_epi32(PRECISION_ROUNDING<<SHIFT_BITS), result),
PRECISION_BITS + SHIFT_BITS);
result = _mm256_packs_epi32(result, result);
result = _mm256_packus_epi16(result, result);
rowOut[x+0] = _mm_cvtsi128_si32(_mm256_castsi256_si128(result));
rowOut[x+1] = _mm256_extract_epi32(result, 4);
}
index = next_index;
idx1 = next_idx1;
idx2 = next_idx2;
}
}
#endif
// This makes sense if 6 or more pixels remain (two loops)
if (x < imOut->xsize - 5) {
__m128i source = _mm_loadl_epi64((__m128i *) &rowIn[x]);
// scale up to 16 bits, but scale * 255 * 256 up to 31 bits
// bi, gi and ri - 6 bits index
// rs, rs and rs - 9 bits shift
// 00 bi1.bs1 gi1.gs1 ri1.rs1 00 bi0.bs0 gi0.gs0 ri0.rs0
__m128i index = _mm_mulhi_epu16(scale,
_mm_unpacklo_epi8(_mm_setzero_si128(), source));
// 0000 0000 idx1 idx0
__m128i index_src = _mm_hadd_epi32(
_mm_madd_epi16(index_mul, _mm_srli_epi16(index, SHIFT_BITS)),
_mm_setzero_si128());
__m128i index = _mm_mullo_epi32(scale, mm_cvtepu8_epi32(&rowIn[x]));
int idx = _mm_cvtsi128_si32(
_mm_hadd_epi32(_mm_hadd_epi32(
_mm_madd_epi16(index_mul, _mm_srli_epi32(index, SCALE_BITS)),
_mm_setzero_si128()), _mm_setzero_si128()));
for (; x < imOut->xsize - 3; x += 2) {
__m128i next_source = _mm_loadl_epi64((__m128i *) &rowIn[x + 2]);
__m128i next_index = _mm_mulhi_epu16(scale,
_mm_unpacklo_epi8(_mm_setzero_si128(), next_source));
__m128i next_index_src = _mm_hadd_epi32(
_mm_madd_epi16(index_mul, _mm_srli_epi16(next_index, SHIFT_BITS)),
_mm_setzero_si128());
int idx0 = _mm_cvtsi128_si32(index_src);
int idx1 = _mm_cvtsi128_si32(_mm_srli_si128(index_src, 4));
// 00 0.bs1 0.gs1 0.rs1 00 0.bs0 0.gs0 0.rs0
__m128i shift = _mm_and_si128(index, scale_mask);
// 11 1-bs1 1-gs1 1-rs1 11 1-bs0 1-gs0 1-rs0
__m128i inv_shift = _mm_sub_epi16(_mm_set1_epi16((1<<SHIFT_BITS)), shift);
// 00 11 bs0 1-bs0 gs0 1-gs0 rs0 1-rs0
__m128i shift0 = _mm_unpacklo_epi16(inv_shift, shift);
// 00 11 bs1 1-bs1 gs1 1-gs1 rs1 1-rs1
__m128i shift1 = _mm_unpackhi_epi16(inv_shift, shift);
if (table_channels == 3) {
__m128i result0 = mm_lut_pixel(table, size2D_shift, size3D_shift,
idx0, shift0, shuffle3);
__m128i result1 = mm_lut_pixel(table, size2D_shift, size3D_shift,
idx1, shift1, shuffle3);
result0 = _mm_packs_epi32(result0, result1);
result0 = _mm_srai_epi16(
_mm_add_epi16(result0, _mm_set1_epi16(PRECISION_ROUNDING)),
PRECISION_BITS);
result0 = _mm_packus_epi16(result0, result0);
result0 = _mm_blendv_epi8(result0, source,
_mm_set_epi8(-1, 0, 0, 0, -1, 0, 0, 0, -1, 0, 0, 0, -1, 0, 0, 0));
_mm_storel_epi64((__m128i*) &rowOut[x], result0);
}
if (table_channels == 4) {
__m128i result0 = mm_lut_pixel(table, size2D_shift, size3D_shift,
idx0, shift0, shuffle4);
__m128i result1 = mm_lut_pixel(table, size2D_shift, size3D_shift,
idx1, shift1, shuffle4);
result0 = _mm_packs_epi32(result0, result1);
result0 = _mm_srai_epi16(
_mm_add_epi16(result0, _mm_set1_epi16(PRECISION_ROUNDING)),
PRECISION_BITS);
_mm_storel_epi64((__m128i*) &rowOut[x], _mm_packus_epi16(result0, result0));
}
source = next_source;
index = next_index;
index_src = next_index_src;
}
}
for (; x < imOut->xsize; x++) {
__m128i next_index = _mm_mullo_epi32(scale, mm_cvtepu8_epi32(&rowIn[x + 1]));
int next_idx = _mm_cvtsi128_si32(
_mm_hadd_epi32(_mm_hadd_epi32(
_mm_madd_epi16(index_mul, _mm_srli_epi32(next_index, SCALE_BITS)),
_mm_setzero_si128()), _mm_setzero_si128()));
__m128i source = _mm_cvtsi32_si128(rowIn[x]);
// scale up to 16 bits, but scale * 255 * 256 up to 31 bits
// bi, gi and ri - 6 bits index
// rs, rs and rs - 9 bits shift
// 00 00 00 00 00 bi.bs gi.gs ri.rs
__m128i index = _mm_mulhi_epu16(scale,
_mm_unpacklo_epi8(_mm_setzero_si128(), source));
__m128i shift = _mm_srli_epi32(
_mm_and_si128(scale_mask, index), (SCALE_BITS - SHIFT_BITS));
int idx0 = _mm_cvtsi128_si32(
_mm_hadd_epi32(
_mm_madd_epi16(index_mul, _mm_srli_epi16(index, SHIFT_BITS)),
_mm_setzero_si128()));
__m128i shift1D, shift2D, shift3D;
__m128i source, left, right, result;
__m128i leftleft, leftright, rightleft, rightright;
// 00 00 00 00 00 0.bs 0.gs 0.rs
__m128i shift = _mm_and_si128(index, scale_mask);
// 11 11 11 11 11 1-bs 1-gs 1-rs
__m128i inv_shift = _mm_sub_epi16(_mm_set1_epi16((1<<SHIFT_BITS)), shift);
shift = _mm_or_si128(
_mm_sub_epi32(_mm_set1_epi32((1<<SHIFT_BITS)-1), shift),
_mm_slli_epi32(shift, 16));
shift1D = _mm_shuffle_epi32(shift, 0x00);
shift2D = _mm_shuffle_epi32(shift, 0x55);
shift3D = _mm_shuffle_epi32(shift, 0xaa);
// 00 11 bs 1-bs gs 1-gs rs 1-rs
__m128i shift0 = _mm_unpacklo_epi16(inv_shift, shift);
if (table_channels == 3) {
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + 0]), shuffle3);
leftleft = _mm_srai_epi32(_mm_madd_epi16(
source, shift1D), SHIFT_BITS);
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + size1D*3]), shuffle3);
leftright = _mm_slli_epi32(_mm_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + size1D_2D*3]), shuffle3);
rightleft = _mm_srai_epi32(_mm_madd_epi16(
source, shift1D), SHIFT_BITS);
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + size1D_2D*3 + size1D*3]), shuffle3);
rightright = _mm_slli_epi32(_mm_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
left = _mm_srai_epi32(_mm_madd_epi16(
_mm_blend_epi16(leftleft, leftright, 0xaa), shift2D),
SHIFT_BITS);
right = _mm_slli_epi32(_mm_madd_epi16(
_mm_blend_epi16(rightleft, rightright, 0xaa), shift2D),
16 - SHIFT_BITS);
result = _mm_madd_epi16(
_mm_blend_epi16(left, right, 0xaa), shift3D);
result = _mm_srai_epi32(_mm_add_epi32(
_mm_set1_epi32(PRECISION_ROUNDING<<SHIFT_BITS), result),
PRECISION_BITS + SHIFT_BITS);
__m128i result = mm_lut_pixel(table, size2D_shift, size3D_shift,
idx0, shift0, shuffle3);
result = _mm_packs_epi32(result, result);
rowOut[x] = _mm_cvtsi128_si32(_mm_packus_epi16(result, result));
rowOut8[x*4 + 3] = rowIn8[x*4 + 3];
result = _mm_srai_epi16(
_mm_add_epi16(result, _mm_set1_epi16(PRECISION_ROUNDING)),
PRECISION_BITS);
result = _mm_packus_epi16(result, result);
result = _mm_blendv_epi8(result, source,
_mm_set_epi8(-1, 0, 0, 0, -1, 0, 0, 0, -1, 0, 0, 0, -1, 0, 0, 0));
rowOut[x] = _mm_cvtsi128_si32(result);
}
if (table_channels == 4) {
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + 0]), shuffle4);
leftleft = _mm_srai_epi32(_mm_madd_epi16(
source, shift1D), SHIFT_BITS);
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + size1D*4]), shuffle4);
leftright = _mm_slli_epi32(_mm_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + size1D_2D*4]), shuffle4);
rightleft = _mm_srai_epi32(_mm_madd_epi16(
source, shift1D), SHIFT_BITS);
source = _mm_shuffle_epi8(
_mm_loadu_si128((__m128i *) &table[idx + size1D_2D*4 + size1D*4]), shuffle4);
rightright = _mm_slli_epi32(_mm_madd_epi16(
source, shift1D), 16 - SHIFT_BITS);
left = _mm_srai_epi32(_mm_madd_epi16(
_mm_blend_epi16(leftleft, leftright, 0xaa), shift2D),
SHIFT_BITS);
right = _mm_slli_epi32(_mm_madd_epi16(
_mm_blend_epi16(rightleft, rightright, 0xaa), shift2D),
16 - SHIFT_BITS);
result = _mm_madd_epi16(
_mm_blend_epi16(left, right, 0xaa), shift3D);
result = _mm_srai_epi32(_mm_add_epi32(
_mm_set1_epi32(PRECISION_ROUNDING<<SHIFT_BITS), result),
PRECISION_BITS + SHIFT_BITS);
__m128i result = mm_lut_pixel(table, size2D_shift, size3D_shift,
idx0, shift0, shuffle4);
result = _mm_packs_epi32(result, result);
result = _mm_srai_epi16(
_mm_add_epi16(result, _mm_set1_epi16(PRECISION_ROUNDING)),
PRECISION_BITS);
rowOut[x] = _mm_cvtsi128_si32(_mm_packus_epi16(result, result));
}
index = next_index;
idx = next_idx;
}
}
ImagingSectionLeave(&cookie);