template<bool avx, bool aligned> void grayscaledToBGRA(const __m_auto_i* const src, const __m_auto_i* const srcEnd, __m_auto_i* const dest)
{
static const __m_auto_i alpha = _mmauto_set1_epi32(0xFF000000);
__m_auto_i* pDest = dest;
for(const __m_auto_i* pSrc = src; pSrc < srcEnd; pSrc++)
{
const __m_auto_i p = _mmauto_loadt_si_all<true>(pSrc);
__m_auto_i pLo = p;
__m_auto_i pHi = p;
_mmauto_unpacklohi_epi8(pLo, pHi);
__m_auto_i pLo2 = pLo;
__m_auto_i pHi2 = pLo;
_mmauto_unpacklohi_epi8(pLo2, pHi2);
_mmauto_storet_si_all<aligned>(pDest++, _mmauto_or_si_all(pLo2, alpha));
_mmauto_storet_si_all<aligned>(pDest++, _mmauto_or_si_all(pHi2, alpha));
pLo2 = pHi;
pHi2 = pHi;
_mmauto_unpacklohi_epi8(pLo2, pHi2);
_mmauto_storet_si_all<aligned>(pDest++, _mmauto_or_si_all(pLo2, alpha));
_mmauto_storet_si_all<aligned>(pDest++, _mmauto_or_si_all(pHi2, alpha));
}
}
template<bool avx, bool aligned> void ALWAYSINLINE storeColors(__m_auto_i* dest, const __m_auto_i p)
{
static const __m_auto_i classNone = _mmauto_set1_epi32(FieldColors::Color::none);
static const __m_auto_i classWhite = _mmauto_set1_epi32(FieldColors::Color::white);
static const __m_auto_i classBlack = _mmauto_set1_epi32(FieldColors::Color::black);
static const __m_auto_i classGreen = _mmauto_set1_epi32(FieldColors::Color::green);
static const __m_auto_i colorNone = _mmauto_set1_epi32(0xFF7F7F7F);
static const __m_auto_i colorWhite = _mmauto_set1_epi32(0xFFFFFFFF);
static const __m_auto_i colorBlack = _mmauto_set1_epi32(0xFF000000);
static const __m_auto_i colorGreen = _mmauto_set1_epi32(0xFF00FF00);
_mmauto_storet_si_all<aligned>(dest,
_mmauto_or_si_all(
_mmauto_or_si_all(
_mmauto_or_si_all(
_mmauto_and_si_all(_mmauto_cmpeq_epi32(p, classNone), colorNone),
_mmauto_and_si_all(_mmauto_cmpeq_epi32(p, classWhite), colorWhite)
),
_mmauto_and_si_all(_mmauto_cmpeq_epi32(p, classBlack), colorBlack)
),
_mmauto_and_si_all(_mmauto_cmpeq_epi32(p, classGreen), colorGreen)
)
);
}
template<bool avx, bool aligned> void rgbToBGRA(const __m_auto_i* const src, const __m_auto_i* const srcEnd, __m_auto_i* const dest)
{
static const __m_auto_i shuffleMask = _mmauto_setr128_epi8(2, 1, 0, char(0xFF), 6, 5, 4, char(0xFF), 10, 9, 8, char(0xFF), 14, 13, 12, char(0xFF));
static const __m_auto_i alpha = _mmauto_set1_epi32(0xFF000000);
__m_auto_i* pDest = dest;
for(const __m_auto_i* pSrc = src; pSrc < srcEnd; pSrc++)
{
_mmauto_storet_si_all<aligned>(pDest++,
_mmauto_or_si_all(
_mmauto_shuffle_epi8(
_mmauto_loadt_si_all<true>(pSrc),
shuffleMask
),
alpha)
);
}
}
template<bool avx> void ALWAYSINLINE storeColors(__m_auto_i* dest, const __m_auto_i p)
{
alignas(avx ? 32 : 16)static __m_auto_i colors[FieldColors::numOfColors] =
{
_mmauto_set1_epi32(0xff7f7f7f), //none
_mmauto_set1_epi32(0xffffffff), //white
_mmauto_set1_epi32(0xff000000), //black
_mmauto_set1_epi32(0xff00ff00), //green
_mmauto_set1_epi32(0xff0000ff), //own team color
_mmauto_set1_epi32(0xffff0000) //opponent team color
};
__m_auto_i result = _mmauto_setzero_si_all();
FOREACH_ENUM((FieldColors) Color, i)
result = _mmauto_or_si_all(result, _mmauto_and_si_all(_mmauto_cmpeq_epi32(p, _mmauto_set1_epi32(i)), colors[i]));
_mmauto_storet_si_all<true>(dest, result);
}
