/*
 * Copyright (C) 2007 Michael Lewis
 * Author: Mike Lewis <mikelikespie@gmail.com>
 *
 * This work is provide AS IS, and has no warranty.
 * The author is NOT responsible for anything that happens
 * due to use of this code, either using it or running it on
 * your system
 */
#ifndef _FAKE_SSE_INCLUDED
#define _FAKE_SSE_INCLUDED
#ifndef __SSE2__
#include <stdlib.h>
#include <string.h>

#ifdef __APPLE__
#include <inttypes.h>
#endif
/*
typedef struct {
	union {
		unsigned char byte[16];
		uint32_t int32[4];
	} u;
} __m128i;
*/
//Shifts this to the left all the way
static inline __m128i _mm_srli_epi32( __m128i A, int count ) {
//printf("_mm_srli_epi32\n");

	int i;
	for( i = 0; i < 4; i++ ) {
		A.u.int32[i] = A.u.int32[i] >> count;
	}
	return A;
}

static inline __m128i _mm_slli_epi32( __m128i A, int count ) {
//printf("_mm_slli_epi32\n");
	int i;
	for( i = 0; i < 4; i++ ) {
		A.u.int32[i] = A.u.int32[i] << count;
	}
	return A;
}

static inline __m128i _mm_slli_si128( __m128i A, int imm ) {
//printf("_mm_srli_si128\n");
	int i;
	__m128i ret;
	for( i = imm; i < 16; i++ ) {
		ret.u.byte[i] = A.u.byte[i-imm];
	}
	for( i = 0; i < imm; i++ ) {
		ret.u.byte[i] = 0x00;
	}
	return ret;
}

static inline __m128i _mm_srli_si128( __m128i A, int imm ) {
//printf("_mm_slli_si128\n");
	int i;
	__m128i ret;
	for( i = 0; i < 16-imm; i++ ) {
		ret.u.byte[i] = A.u.byte[i+imm];
	}
	for( i = 16-imm; i < 16; i++ ) {
		ret.u.byte[i] = 0x00;
	}
	return ret;
}

static inline __m128i _mm_setzero_si128() {
//printf("_mm_setzero_si128\n");
	__m128i r;
	memset( &r, 0, sizeof( r ));
	return r;
}

static inline __m128i _mm_cmpeq_epi8( __m128i A, __m128i B ) { 
//printf("_mm_cmpeq_epi8\n");
	__m128i ret;
	int i;
	for( i = 0; i < 16; i++ ) {
		ret.u.byte[i] = ( A.u.byte[i] == B.u.byte[i] ) ? 0xFF : 0x00;
	}
	return ret;
}
static inline __m128i _mm_add_epi8( __m128i A, __m128i B ) { 
//printf("_mm_add_epi8\n");
	__m128i ret;
	int i;
	for( i = 0; i < 16; i++ ) {
		ret.u.byte[i] = A.u.byte[i] + B.u.byte[i];
	}
	return ret;
}

static inline __m128i _mm_set_epi8 (char __q15, char __q14, char __q13, char __q12,
	      char __q11, char __q10, char __q09, char __q08,
	      char __q07, char __q06, char __q05, char __q04,
	      char __q03, char __q02, char __q01, char __q00)
{
//printf("_mm_set_epi8 \n");
	__m128i ret;
	ret.u.byte[15] = __q15;
	ret.u.byte[14] = __q14;
	ret.u.byte[13] = __q13;
	ret.u.byte[12] = __q12;
	ret.u.byte[11] = __q11;
	ret.u.byte[10] = __q10;
	ret.u.byte[9] = __q09;
	ret.u.byte[8] = __q08;
	ret.u.byte[7] = __q07;
	ret.u.byte[6] = __q06;
	ret.u.byte[5] = __q05;
	ret.u.byte[4] = __q04;
	ret.u.byte[3] = __q03;
	ret.u.byte[2] = __q02;
	ret.u.byte[1] = __q01;
	ret.u.byte[0] = __q00;
	return ret;
}
static inline __m128i _mm_set1_epi8 ( char f ) {
//printf("_mm_set1_epi8 \n");
	int i;
	__m128i ret;
	for( i = 0; i < 16; i++ ) {
		ret.u.byte[i] = f;
	}
	return ret;
}


static inline __m128i _mm_and_si128( __m128i A, __m128i B ) {
//printf("_mm_and_si128\n");
	__m128i ret;
	int i;
	for( i = 0; i < 4; i++ ) {
		ret.u.int32[i] = A.u.int32[i] & B.u.int32[i];
	}
	return ret;
}

static inline __m128i _mm_or_si128( __m128i A, __m128i B ) {
//printf("_mm_or_si128\n");
	__m128i ret;
	int i;
	for( i = 0; i < 4; i++ ) {
		ret.u.int32[i] = A.u.int32[i] | B.u.int32[i];
	}
	return ret;
}

#endif
#endif //_FAKE_SSE_INCLUDED