2023-08-06 20:52:13 -07:00
|
|
|
/* ScummVM - Graphic Adventure Engine
|
|
|
|
*
|
|
|
|
* ScummVM is the legal property of its developers, whose names
|
|
|
|
* are too numerous to list here. Please refer to the COPYRIGHT
|
|
|
|
* file distributed with this source distribution.
|
|
|
|
*
|
|
|
|
* This program is free software: you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
|
|
* (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program 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 General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
2023-08-08 20:07:46 -07:00
|
|
|
#include "common/scummsys.h"
|
2023-08-06 20:52:13 -07:00
|
|
|
#include <immintrin.h>
|
|
|
|
|
2023-10-22 16:55:26 +01:00
|
|
|
#include "graphics/blit/blit-alpha.h"
|
2023-08-06 20:52:13 -07:00
|
|
|
#include "graphics/pixelformat.h"
|
|
|
|
|
|
|
|
namespace Graphics {
|
|
|
|
|
|
|
|
static FORCEINLINE __m128i sse2_mul32(__m128i a, __m128i b) {
|
2023-10-21 23:45:47 +03:00
|
|
|
__m128i even = _mm_shuffle_epi32(_mm_mul_epu32(a, b), _MM_SHUFFLE(0, 0, 2, 0));
|
|
|
|
__m128i odd = _mm_shuffle_epi32(_mm_mul_epu32(_mm_bsrli_si128(a, 4), _mm_bsrli_si128(b, 4)), _MM_SHUFFLE(0, 0, 2, 0));
|
|
|
|
return _mm_unpacklo_epi32(even, odd);
|
2023-08-06 20:52:13 -07:00
|
|
|
}
|
|
|
|
|
2023-10-22 16:55:26 +01:00
|
|
|
class BlendBlitImpl_SSE2 : public BlendBlitImpl_Base {
|
2023-10-21 23:58:43 +03:00
|
|
|
friend class BlendBlit;
|
|
|
|
|
2023-08-06 20:52:13 -07:00
|
|
|
template<bool doscale, bool rgbmod, bool alphamod>
|
2023-10-22 23:05:37 +01:00
|
|
|
struct AlphaBlend : public BlendBlitImpl_Base::AlphaBlend<doscale, rgbmod, alphamod> {
|
2023-10-21 23:45:47 +03:00
|
|
|
static inline __m128i simd(__m128i src, __m128i dst, const bool flip, const byte ca, const byte cr, const byte cg, const byte cb) {
|
|
|
|
__m128i ina;
|
|
|
|
if (alphamod)
|
|
|
|
ina = _mm_srli_epi32(_mm_mullo_epi16(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kAModMask)), _mm_set1_epi32(ca)), 8);
|
|
|
|
else
|
|
|
|
ina = _mm_and_si128(src, _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
__m128i alphaMask = _mm_cmpeq_epi32(ina, _mm_setzero_si128());
|
|
|
|
|
|
|
|
if (rgbmod) {
|
|
|
|
__m128i dstR = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kRModMask)), BlendBlit::kRModShift);
|
|
|
|
__m128i dstG = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i dstB = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
__m128i srcR = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kRModMask)), BlendBlit::kRModShift);
|
|
|
|
__m128i srcG = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i srcB = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
|
|
|
|
dstR = _mm_slli_epi32(_mm_mullo_epi16(dstR, _mm_sub_epi32(_mm_set1_epi32(255), ina)), BlendBlit::kRModShift - 8);
|
|
|
|
dstG = _mm_slli_epi32(_mm_mullo_epi16(dstG, _mm_sub_epi32(_mm_set1_epi32(255), ina)), BlendBlit::kGModShift - 8);
|
|
|
|
dstB = _mm_mullo_epi16(dstB, _mm_sub_epi32(_mm_set1_epi32(255), ina));
|
|
|
|
srcR = _mm_add_epi32(dstR, _mm_slli_epi32(_mm_mullo_epi16(_mm_srli_epi32(_mm_mullo_epi16(srcR, ina), 8), _mm_set1_epi32(cr)), BlendBlit::kRModShift - 8));
|
|
|
|
srcG = _mm_add_epi32(dstG, _mm_slli_epi32(_mm_mullo_epi16(_mm_srli_epi32(_mm_mullo_epi16(srcG, ina), 8), _mm_set1_epi32(cg)), BlendBlit::kGModShift - 8));
|
|
|
|
srcB = _mm_add_epi32(dstB, _mm_mullo_epi16(_mm_srli_epi32(_mm_mullo_epi16(srcB, ina), 8), _mm_set1_epi32(cb)));
|
|
|
|
src = _mm_or_si128(_mm_and_si128(srcB, _mm_set1_epi32(BlendBlit::kBModMask)), _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
src = _mm_or_si128(_mm_and_si128(srcG, _mm_set1_epi32(BlendBlit::kGModMask)), src);
|
|
|
|
src = _mm_or_si128(_mm_and_si128(srcR, _mm_set1_epi32(BlendBlit::kRModMask)), src);
|
|
|
|
} else {
|
|
|
|
__m128i dstRB = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kRModMask | BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
__m128i srcRB = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kRModMask | BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
__m128i dstG = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i srcG = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
|
|
|
|
dstRB = _mm_srli_epi32(sse2_mul32(dstRB, _mm_sub_epi32(_mm_set1_epi32(255), ina)), 8);
|
|
|
|
dstG = _mm_srli_epi32(_mm_mullo_epi16(dstG, _mm_sub_epi32(_mm_set1_epi32(255), ina)), 8);
|
|
|
|
srcRB = _mm_slli_epi32(_mm_add_epi32(dstRB, _mm_srli_epi32(sse2_mul32(srcRB, ina), 8)), BlendBlit::kBModShift);
|
|
|
|
srcG = _mm_slli_epi32(_mm_add_epi32(dstG, _mm_srli_epi32(_mm_mullo_epi16(srcG, ina), 8)), BlendBlit::kGModShift);
|
|
|
|
src = _mm_or_si128(_mm_and_si128(srcG, _mm_set1_epi32(BlendBlit::kGModMask)), _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
src = _mm_or_si128(_mm_and_si128(srcRB, _mm_set1_epi32(BlendBlit::kBModMask | BlendBlit::kRModMask)), src);
|
|
|
|
}
|
|
|
|
|
|
|
|
dst = _mm_and_si128(alphaMask, dst);
|
|
|
|
src = _mm_andnot_si128(alphaMask, src);
|
|
|
|
return _mm_or_si128(dst, src);
|
|
|
|
}
|
2023-08-06 20:52:13 -07:00
|
|
|
};
|
|
|
|
|
|
|
|
template<bool doscale, bool rgbmod, bool alphamod>
|
2023-10-22 23:05:37 +01:00
|
|
|
struct MultiplyBlend : public BlendBlitImpl_Base::MultiplyBlend<doscale, rgbmod, alphamod> {
|
2023-10-21 23:45:47 +03:00
|
|
|
static inline __m128i simd(__m128i src, __m128i dst, const bool flip, const byte ca, const byte cr, const byte cg, const byte cb) {
|
|
|
|
__m128i ina, alphaMask;
|
|
|
|
if (alphamod) {
|
|
|
|
ina = _mm_srli_epi32(_mm_mullo_epi16(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kAModMask)), _mm_set1_epi32(ca)), 8);
|
2023-10-21 23:43:29 +03:00
|
|
|
alphaMask = _mm_cmpeq_epi32(ina, _mm_setzero_si128());
|
|
|
|
} else {
|
2023-10-21 23:45:47 +03:00
|
|
|
ina = _mm_and_si128(src, _mm_set1_epi32(BlendBlit::kAModMask));
|
2023-10-21 23:43:29 +03:00
|
|
|
alphaMask = _mm_set1_epi32(BlendBlit::kAModMask);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (rgbmod) {
|
|
|
|
__m128i srcB = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
__m128i srcG = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i srcR = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kRModMask)), BlendBlit::kRModShift);
|
|
|
|
__m128i dstB = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
__m128i dstG = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i dstR = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kRModMask)), BlendBlit::kRModShift);
|
|
|
|
|
|
|
|
srcB = _mm_and_si128(_mm_slli_epi32(_mm_mullo_epi16(dstB, _mm_srli_epi32(sse2_mul32(_mm_mullo_epi16(srcB, _mm_set1_epi32(cb)), ina), 16)), BlendBlit::kBModShift - 8), _mm_set1_epi32(BlendBlit::kBModMask));
|
|
|
|
srcG = _mm_and_si128(_mm_slli_epi32(_mm_mullo_epi16(dstG, _mm_srli_epi32(sse2_mul32(_mm_mullo_epi16(srcG, _mm_set1_epi32(cg)), ina), 16)), BlendBlit::kGModShift - 8), _mm_set1_epi32(BlendBlit::kGModMask));
|
|
|
|
srcR = _mm_and_si128(_mm_slli_epi32(_mm_mullo_epi16(dstR, _mm_srli_epi32(sse2_mul32(_mm_mullo_epi16(srcR, _mm_set1_epi32(cr)), ina), 16)), BlendBlit::kRModShift - 8), _mm_set1_epi32(BlendBlit::kRModMask));
|
|
|
|
|
|
|
|
src = _mm_and_si128(src, _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
src = _mm_or_si128(src, _mm_or_si128(srcB, _mm_or_si128(srcG, srcR)));
|
|
|
|
} else {
|
|
|
|
constexpr uint32 rbMask = BlendBlit::kRModMask | BlendBlit::kBModMask;
|
2023-10-21 23:45:47 +03:00
|
|
|
__m128i srcG = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i srcRB = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(rbMask)), BlendBlit::kBModShift);
|
|
|
|
__m128i dstG = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i dstRB = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(rbMask)), BlendBlit::kBModShift);
|
2023-08-07 17:36:29 -07:00
|
|
|
|
2023-10-21 23:45:47 +03:00
|
|
|
srcG = _mm_and_si128(_mm_slli_epi32(_mm_mullo_epi16(dstG, _mm_srli_epi32(_mm_mullo_epi16(srcG, ina), 8)), 8), _mm_set1_epi32(BlendBlit::kGModMask));
|
2023-10-21 23:43:29 +03:00
|
|
|
srcRB = _mm_and_si128(_mm_mullo_epi16(dstRB, _mm_srli_epi32(_mm_and_si128(sse2_mul32(srcRB, ina), _mm_set1_epi32(rbMask)), 8)), _mm_set1_epi32(rbMask));
|
|
|
|
|
2023-10-21 23:45:47 +03:00
|
|
|
src = _mm_and_si128(src, _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
src = _mm_or_si128(src, _mm_or_si128(srcRB, srcG));
|
|
|
|
}
|
|
|
|
|
|
|
|
dst = _mm_and_si128(alphaMask, dst);
|
|
|
|
src = _mm_andnot_si128(alphaMask, src);
|
|
|
|
return _mm_or_si128(dst, src);
|
|
|
|
}
|
2023-08-06 20:52:13 -07:00
|
|
|
};
|
|
|
|
|
|
|
|
template<bool doscale, bool rgbmod, bool alphamod>
|
2023-10-22 23:05:37 +01:00
|
|
|
struct OpaqueBlend : public BlendBlitImpl_Base::OpaqueBlend<doscale, rgbmod, alphamod> {
|
2023-10-21 23:45:47 +03:00
|
|
|
static inline __m128i simd(__m128i src, __m128i dst, const bool flip, const byte ca, const byte cr, const byte cg, const byte cb) {
|
|
|
|
return _mm_or_si128(src, _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
}
|
2023-08-06 20:52:13 -07:00
|
|
|
};
|
|
|
|
|
|
|
|
template<bool doscale, bool rgbmod, bool alphamod>
|
2023-10-22 23:05:37 +01:00
|
|
|
struct BinaryBlend : public BlendBlitImpl_Base::BinaryBlend<doscale, rgbmod, alphamod> {
|
2023-10-21 23:45:47 +03:00
|
|
|
static inline __m128i simd(__m128i src, __m128i dst, const bool flip, const byte ca, const byte cr, const byte cg, const byte cb) {
|
|
|
|
__m128i alphaMask = _mm_cmpeq_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kAModMask)), _mm_setzero_si128());
|
|
|
|
dst = _mm_and_si128(dst, alphaMask);
|
|
|
|
src = _mm_andnot_si128(alphaMask, _mm_or_si128(src, _mm_set1_epi32(BlendBlit::kAModMask)));
|
|
|
|
return _mm_or_si128(src, dst);
|
|
|
|
}
|
2023-08-06 20:52:13 -07:00
|
|
|
};
|
|
|
|
|
|
|
|
template<bool doscale, bool rgbmod, bool alphamod>
|
2023-10-22 23:05:37 +01:00
|
|
|
struct AdditiveBlend : public BlendBlitImpl_Base::AdditiveBlend<doscale, rgbmod, alphamod> {
|
2023-10-21 23:45:47 +03:00
|
|
|
static inline __m128i simd(__m128i src, __m128i dst, const bool flip, const byte ca, const byte cr, const byte cg, const byte cb) {
|
|
|
|
__m128i ina;
|
|
|
|
if (alphamod)
|
|
|
|
ina = _mm_srli_epi32(sse2_mul32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kAModMask)), _mm_set1_epi32(ca)), 8);
|
|
|
|
else
|
|
|
|
ina = _mm_and_si128(src, _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
__m128i alphaMask = _mm_cmpeq_epi32(ina, _mm_set1_epi32(0));
|
|
|
|
|
|
|
|
if (rgbmod) {
|
|
|
|
__m128i srcb = _mm_and_si128(src, _mm_set1_epi32(BlendBlit::kBModMask));
|
|
|
|
__m128i srcg = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i srcr = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kRModMask)), BlendBlit::kRModShift);
|
|
|
|
__m128i dstb = _mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kBModMask));
|
|
|
|
__m128i dstg = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i dstr = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kRModMask)), BlendBlit::kRModShift);
|
|
|
|
|
|
|
|
srcb = _mm_and_si128(_mm_add_epi32(dstb, _mm_srli_epi32(sse2_mul32(srcb, sse2_mul32(_mm_set1_epi32(cb), ina)), 16)), _mm_set1_epi32(BlendBlit::kBModMask));
|
|
|
|
srcg = _mm_and_si128(_mm_add_epi32(dstg, sse2_mul32(srcg, sse2_mul32(_mm_set1_epi32(cg), ina))), _mm_set1_epi32(BlendBlit::kGModMask));
|
|
|
|
srcr = _mm_and_si128(_mm_add_epi32(dstr, _mm_srli_epi32(sse2_mul32(srcr, sse2_mul32(_mm_set1_epi32(cr), ina)), BlendBlit::kRModShift - 16)), _mm_set1_epi32(BlendBlit::kRModMask));
|
|
|
|
|
|
|
|
src = _mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
src = _mm_or_si128(src, _mm_or_si128(srcb, _mm_or_si128(srcg, srcr)));
|
|
|
|
} else if (alphamod) {
|
|
|
|
__m128i srcg = _mm_and_si128(src, _mm_set1_epi32(BlendBlit::kGModMask));
|
|
|
|
__m128i srcrb = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kRModMask | BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
__m128i dstg = _mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kGModMask));
|
|
|
|
__m128i dstrb = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kRModMask | BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
|
|
|
|
srcg = _mm_and_si128(_mm_add_epi32(dstg, _mm_srli_epi32(sse2_mul32(srcg, ina), 8)), _mm_set1_epi32(BlendBlit::kGModMask));
|
|
|
|
srcrb = _mm_and_si128(_mm_add_epi32(dstrb, sse2_mul32(srcrb, ina)), _mm_set1_epi32(BlendBlit::kRModMask | BlendBlit::kBModMask));
|
|
|
|
|
|
|
|
src = _mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
src = _mm_or_si128(src, _mm_or_si128(srcrb, srcg));
|
|
|
|
} else {
|
|
|
|
__m128i srcg = _mm_and_si128(src, _mm_set1_epi32(BlendBlit::kGModMask));
|
|
|
|
__m128i srcrb = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kRModMask | BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
__m128i dstg = _mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kGModMask));
|
|
|
|
__m128i dstrb = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kRModMask | BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
|
|
|
|
srcg = _mm_and_si128(_mm_add_epi32(dstg, srcg), _mm_set1_epi32(BlendBlit::kGModMask));
|
|
|
|
srcrb = _mm_and_si128(_mm_slli_epi32(_mm_add_epi32(dstrb, srcrb), 8), _mm_set1_epi32(BlendBlit::kRModMask | BlendBlit::kBModMask));
|
|
|
|
|
|
|
|
src = _mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
src = _mm_or_si128(src, _mm_or_si128(srcrb, srcg));
|
|
|
|
}
|
|
|
|
|
|
|
|
dst = _mm_and_si128(alphaMask, dst);
|
|
|
|
src = _mm_andnot_si128(alphaMask, src);
|
|
|
|
return _mm_or_si128(dst, src);
|
|
|
|
}
|
2023-08-06 20:52:13 -07:00
|
|
|
};
|
|
|
|
|
|
|
|
template<bool doscale, bool rgbmod, bool alphamod>
|
2023-10-22 23:05:37 +01:00
|
|
|
struct SubtractiveBlend : public BlendBlitImpl_Base::SubtractiveBlend<doscale, rgbmod, alphamod> {
|
2023-10-21 23:45:47 +03:00
|
|
|
static inline __m128i simd(__m128i src, __m128i dst, const bool flip, const byte ca, const byte cr, const byte cg, const byte cb) {
|
|
|
|
__m128i ina = _mm_and_si128(src, _mm_set1_epi32(BlendBlit::kAModMask));
|
|
|
|
__m128i srcb = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
__m128i srcg = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i srcr = _mm_srli_epi32(_mm_and_si128(src, _mm_set1_epi32(BlendBlit::kRModMask)), BlendBlit::kRModShift);
|
|
|
|
__m128i dstb = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kBModMask)), BlendBlit::kBModShift);
|
|
|
|
__m128i dstg = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kGModMask)), BlendBlit::kGModShift);
|
|
|
|
__m128i dstr = _mm_srli_epi32(_mm_and_si128(dst, _mm_set1_epi32(BlendBlit::kRModMask)), BlendBlit::kRModShift);
|
|
|
|
|
|
|
|
srcb = _mm_and_si128(_mm_slli_epi32(_mm_max_epi16(_mm_sub_epi32(dstb, _mm_srli_epi32(sse2_mul32(sse2_mul32(srcb, _mm_set1_epi32(cb)), sse2_mul32(dstb, ina)), 24)), _mm_set1_epi32(0)), BlendBlit::kBModShift), _mm_set1_epi32(BlendBlit::kBModMask));
|
|
|
|
srcg = _mm_and_si128(_mm_slli_epi32(_mm_max_epi16(_mm_sub_epi32(dstg, _mm_srli_epi32(sse2_mul32(sse2_mul32(srcg, _mm_set1_epi32(cg)), sse2_mul32(dstg, ina)), 24)), _mm_set1_epi32(0)), BlendBlit::kGModShift), _mm_set1_epi32(BlendBlit::kGModMask));
|
|
|
|
srcr = _mm_and_si128(_mm_slli_epi32(_mm_max_epi16(_mm_sub_epi32(dstr, _mm_srli_epi32(sse2_mul32(sse2_mul32(srcr, _mm_set1_epi32(cr)), sse2_mul32(dstr, ina)), 24)), _mm_set1_epi32(0)), BlendBlit::kRModShift), _mm_set1_epi32(BlendBlit::kRModMask));
|
|
|
|
|
|
|
|
return _mm_or_si128(_mm_set1_epi32(BlendBlit::kAModMask), _mm_or_si128(srcb, _mm_or_si128(srcg, srcr)));
|
|
|
|
}
|
2023-08-06 20:52:13 -07:00
|
|
|
};
|
|
|
|
|
|
|
|
public:
|
|
|
|
template<template <bool DOSCALE, bool RGBMOD, bool ALPHAMOD> class PixelFunc, bool doscale, bool rgbmod, bool alphamod, bool coloradd1, bool loaddst>
|
|
|
|
static inline void blitInnerLoop(BlendBlit::Args &args) {
|
2023-10-21 23:45:47 +03:00
|
|
|
const byte *in;
|
|
|
|
byte *out;
|
|
|
|
|
|
|
|
const byte rawcr = (args.color >> BlendBlit::kRModShift) & 0xFF;
|
|
|
|
const byte rawcg = (args.color >> BlendBlit::kGModShift) & 0xFF;
|
|
|
|
const byte rawcb = (args.color >> BlendBlit::kBModShift) & 0xFF;
|
|
|
|
const byte ca = alphamod ? ((args.color >> BlendBlit::kAModShift) & 0xFF) : 255;
|
|
|
|
const uint32 cr = coloradd1 ? (rgbmod ? (rawcr == 255 ? 256 : rawcr) : 256) : (rgbmod ? rawcr : 255);
|
|
|
|
const uint32 cg = coloradd1 ? (rgbmod ? (rawcg == 255 ? 256 : rawcg) : 256) : (rgbmod ? rawcg : 255);
|
|
|
|
const uint32 cb = coloradd1 ? (rgbmod ? (rawcb == 255 ? 256 : rawcb) : 256) : (rgbmod ? rawcb : 255);
|
|
|
|
|
|
|
|
int scaleXCtr, scaleYCtr = args.scaleYoff;
|
|
|
|
const byte *inBase;
|
|
|
|
|
|
|
|
if (!doscale && (args.flipping & FLIP_H)) args.ino -= 4 * 3;
|
|
|
|
|
|
|
|
for (uint32 i = 0; i < args.height; i++) {
|
|
|
|
if (doscale) {
|
|
|
|
inBase = args.ino + scaleYCtr / BlendBlit::SCALE_THRESHOLD * args.inoStep;
|
|
|
|
scaleXCtr = args.scaleXoff;
|
|
|
|
} else {
|
|
|
|
in = args.ino;
|
|
|
|
}
|
|
|
|
out = args.outo;
|
|
|
|
|
|
|
|
uint32 j = 0;
|
|
|
|
for (; j + 4 <= args.width; j += 4) {
|
|
|
|
__m128i dstPixels, srcPixels;
|
|
|
|
if (loaddst) dstPixels = _mm_loadu_si128((const __m128i *)out);
|
|
|
|
if (!doscale) {
|
|
|
|
srcPixels = _mm_loadu_si128((const __m128i *)in);
|
|
|
|
} else {
|
|
|
|
srcPixels = _mm_setr_epi32(
|
|
|
|
*(const uint32 *)(inBase + (ptrdiff_t)(scaleXCtr + args.scaleX * 0) / (ptrdiff_t)BlendBlit::SCALE_THRESHOLD * args.inStep),
|
|
|
|
*(const uint32 *)(inBase + (ptrdiff_t)(scaleXCtr + args.scaleX * 1) / (ptrdiff_t)BlendBlit::SCALE_THRESHOLD * args.inStep),
|
|
|
|
*(const uint32 *)(inBase + (ptrdiff_t)(scaleXCtr + args.scaleX * 2) / (ptrdiff_t)BlendBlit::SCALE_THRESHOLD * args.inStep),
|
|
|
|
*(const uint32 *)(inBase + (ptrdiff_t)(scaleXCtr + args.scaleX * 3) / (ptrdiff_t)BlendBlit::SCALE_THRESHOLD * args.inStep)
|
|
|
|
);
|
|
|
|
scaleXCtr += args.scaleX * 4;
|
|
|
|
}
|
|
|
|
if (!doscale && (args.flipping & FLIP_H)) {
|
|
|
|
srcPixels = _mm_shuffle_epi32(srcPixels, _MM_SHUFFLE(0, 1, 2, 3));
|
|
|
|
}
|
|
|
|
{
|
|
|
|
const __m128i res = PixelFunc<doscale, rgbmod, alphamod>::simd(srcPixels, dstPixels, args.flipping & FLIP_H, ca, cr, cg, cb);
|
|
|
|
_mm_storeu_si128((__m128i *)out, res);
|
|
|
|
}
|
|
|
|
if (!doscale) in += (ptrdiff_t)args.inStep * 4;
|
|
|
|
out += 4ULL * 4;
|
|
|
|
}
|
|
|
|
if (!doscale && (args.flipping & FLIP_H)) in += 4 * 3;
|
|
|
|
for (; j < args.width; j++) {
|
|
|
|
if (doscale) {
|
|
|
|
in = inBase + scaleXCtr / BlendBlit::SCALE_THRESHOLD * args.inStep;
|
|
|
|
}
|
|
|
|
|
|
|
|
PixelFunc<doscale, rgbmod, alphamod>::normal(in, out, ca, cr, cg, cb);
|
|
|
|
|
|
|
|
if (doscale)
|
|
|
|
scaleXCtr += args.scaleX;
|
|
|
|
else
|
|
|
|
in += args.inStep;
|
|
|
|
out += 4;
|
|
|
|
}
|
|
|
|
if (doscale)
|
|
|
|
scaleYCtr += args.scaleY;
|
|
|
|
else
|
|
|
|
args.ino += args.inoStep;
|
|
|
|
args.outo += args.dstPitch;
|
|
|
|
}
|
2023-08-06 20:52:13 -07:00
|
|
|
}
|
|
|
|
|
2023-10-21 23:58:43 +03:00
|
|
|
}; // End of class BlendBlitImpl_SSE2
|
2023-08-06 20:52:13 -07:00
|
|
|
|
2023-08-08 20:07:46 -07:00
|
|
|
void BlendBlit::blitSSE2(Args &args, const TSpriteBlendMode &blendMode, const AlphaType &alphaType) {
|
2023-10-22 16:55:26 +01:00
|
|
|
blitT<BlendBlitImpl_SSE2>(args, blendMode, alphaType);
|
2023-08-06 20:52:13 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
} // End of namespace Graphics
|