
#include "gf16_muladd_multi.h"

#ifdef _AVAILABLE
static HEDLEY_ALWAYS_INLINE void _FN(gf_add_x)(
	const void *HEDLEY_RESTRICT scratch,
	GF16_BLKMAC_SRCDSTLIST, size_t len,
	const uint16_t *HEDLEY_RESTRICT coefficients,
	const int doPrefetch, const char* _pf
) {
	ASSUME(((uintptr_t)_dst1 & (sizeof(_mword)-1)) == 0);
	ASSUME(len > 0);
	
	GF16_BLKMAC_SRCDST_UNUSED(18, 1);
	UNUSED(coefficients);
	unsigned vecStride = (unsigned)((uintptr_t)scratch); // abuse this otherwise unused variable
	ASSUME((len & (sizeof(_mword)*vecStride-1)) == 0);
	// vecStride assumed to be a known compile-time constant
	
	for(intptr_t ptr = -(intptr_t)len; ptr; ptr += sizeof(_mword)*vecStride) {
		for(unsigned v=0; v<vecStride; v++) {
			_mword data = _MMI(load)((_mword*)(_dst1+ptr*dstScale) + v);
			#ifdef _ADD_USE_TERNLOG
			# define ADD_PAIR(m, n) \
				if(srcCount == m) \
					data = _MMI(xor)(data, _MMI(load)((_mword*)(_src##m+ptr*srcScale) + v)); \
				else if(srcCount > m) \
					data = _MM(ternarylogic_epi32)(data, \
						_MMI(load)((_mword*)(_src##m+ptr*srcScale) + v), \
						_MMI(load)((_mword*)(_src##n+ptr*srcScale) + v), \
					0x96)
			#else
			# define ADD_PAIR(m, n) \
				if(srcCount >= m) \
					data = _MMI(xor)(data, _MMI(load)((_mword*)(_src##m+ptr*srcScale) + v)); \
				if(srcCount >= n) \
					data = _MMI(xor)(data, _MMI(load)((_mword*)(_src##n+ptr*srcScale) + v))
			#endif
			ADD_PAIR(1, 2);
			ADD_PAIR(3, 4);
			ADD_PAIR(5, 6);
			ADD_PAIR(7, 8);
			ADD_PAIR(9, 10);
			ADD_PAIR(11, 12);
			ADD_PAIR(13, 14);
			ADD_PAIR(15, 16);
			ADD_PAIR(17, 18);
			#undef ADD_PAIR
			_MMI(store)((_mword*)(_dst1+ptr*dstScale) + v, data);
		}
		
		if(vecStride == 16) {
			// for xor kernels, need to do 4x prefetch
			if(doPrefetch) {
				const char* pfBase = _pf+(ptr>>1);
				if(doPrefetch == 1) {
					_mm_prefetch(pfBase, MM_HINT_WT1);
					_mm_prefetch(pfBase+64, MM_HINT_WT1);
					if(sizeof(_mword) > 16) {
						_mm_prefetch(pfBase+128, MM_HINT_WT1);
						_mm_prefetch(pfBase+192, MM_HINT_WT1);
					}
					if(sizeof(_mword) > 32) {
						_mm_prefetch(pfBase+256, MM_HINT_WT1);
						_mm_prefetch(pfBase+320, MM_HINT_WT1);
						_mm_prefetch(pfBase+384, MM_HINT_WT1);
						_mm_prefetch(pfBase+448, MM_HINT_WT1);
					}
				}
				if(doPrefetch == 2) {
					_mm_prefetch(pfBase, _MM_HINT_T1);
					_mm_prefetch(pfBase+64, _MM_HINT_T1);
					if(sizeof(_mword) > 16) {
						_mm_prefetch(pfBase+128, _MM_HINT_T1);
						_mm_prefetch(pfBase+192, _MM_HINT_T1);
					}
					if(sizeof(_mword) > 32) {
						_mm_prefetch(pfBase+256, _MM_HINT_T1);
						_mm_prefetch(pfBase+320, _MM_HINT_T1);
						_mm_prefetch(pfBase+384, _MM_HINT_T1);
						_mm_prefetch(pfBase+448, _MM_HINT_T1);
					}
				}
			}
		} else {
			if(doPrefetch == 1)
				_mm_prefetch(_pf+(ptr/vecStride), MM_HINT_WT1);
			if(doPrefetch == 2)
				_mm_prefetch(_pf+(ptr/vecStride), _MM_HINT_T1);
		}
	}
}
#endif
