/*
 * matchfinder_sse2.h
 *
 * Matchfinding routines optimized for Intel SSE2 (Streaming SIMD Extensions).
 */

#include <emmintrin.h>

static inline bool
matchfinder_init_sse2(pos_t *data, size_t size)
{
	__m128i v, *p;
	size_t n;

	if (size % sizeof(__m128i) * 4)
		return false;

	if (sizeof(pos_t) == 2)
		v = _mm_set1_epi16(MATCHFINDER_INITVAL);
	else if (sizeof(pos_t) == 4)
		v = _mm_set1_epi32(MATCHFINDER_INITVAL);
	else
		return false;

	p = (__m128i *)data;
	n = size / (sizeof(__m128i) * 4);
	do {
		p[0] = v;
		p[1] = v;
		p[2] = v;
		p[3] = v;
		p += 4;
	} while (--n);
	return true;
}

static inline bool
matchfinder_rebase_sse2(pos_t *data, size_t size)
{
	__m128i v, *p;
	size_t n;

	if ((size % sizeof(__m128i) * 4 != 0))
		return false;

	if (sizeof(pos_t) == 2)
		v = _mm_set1_epi16((pos_t)-MATCHFINDER_WINDOW_SIZE);
	else if (sizeof(pos_t) == 4)
		v = _mm_set1_epi32((pos_t)-MATCHFINDER_WINDOW_SIZE);
	else
		return false;

	p = (__m128i *)data;
	n = size / (sizeof(__m128i) * 4);
	do {
		/* PADDSW: Add Packed Signed Integers With Signed Saturation  */
		p[0] = _mm_adds_epi16(p[0], v);
		p[1] = _mm_adds_epi16(p[1], v);
		p[2] = _mm_adds_epi16(p[2], v);
		p[3] = _mm_adds_epi16(p[3], v);
		p += 4;
	} while (--n);
	return true;
}