// Copyright (c) 2019. Temple3x (temple3x@gmail.com)
//
// Use of this source code is governed by the MIT License
// that can be found in the LICENSE file.
 
#include "textflag.h"

#define dst BX // parity's address
#define d2src SI // two-dimension src_slice's address
#define csrc CX // cnt of src
#define len DX // len of vect
#define pos R8 // job position in vect

#define csrc_tmp R9
#define d2src_off R10
#define src_tmp R11
#define not_aligned_len R12
#define src_val0 R13
#define src_val1 R14

// func encodeSSE2(dst []byte, src [][]byte)
TEXT ·encodeSSE2(SB), NOSPLIT, $0
	MOVQ  d+0(FP), dst
	MOVQ  src+24(FP), d2src
	MOVQ  c+32(FP), csrc
	MOVQ  l+8(FP), len
	TESTQ $63, len
	JNZ   not_aligned

aligned:
	MOVQ $0, pos

loop64b:
	MOVQ  csrc, csrc_tmp
	SUBQ  $2, csrc_tmp
	MOVQ  $0, d2src_off
	MOVQ  (d2src)(d2src_off*1), src_tmp
	MOVOU (src_tmp)(pos*1), X0
	MOVOU 16(src_tmp)(pos*1), X1
	MOVOU 32(src_tmp)(pos*1), X2
	MOVOU 48(src_tmp)(pos*1), X3

next_vect:
	ADDQ  $24, d2src_off
	MOVQ  (d2src)(d2src_off*1), src_tmp
	MOVOU (src_tmp)(pos*1), X4
	MOVOU 16(src_tmp)(pos*1), X5
	MOVOU 32(src_tmp)(pos*1), X6
	MOVOU 48(src_tmp)(pos*1), X7
	PXOR  X4, X0
	PXOR  X5, X1
	PXOR  X6, X2
	PXOR  X7, X3
	SUBQ  $1, csrc_tmp
	JGE   next_vect

	MOVOU X0, (dst)(pos*1)
	MOVOU X1, 16(dst)(pos*1)
	MOVOU X2, 32(dst)(pos*1)
	MOVOU X3, 48(dst)(pos*1)

	ADDQ $64, pos
	CMPQ len, pos
	JNE  loop64b
	RET

loop_1b:
	MOVQ csrc, csrc_tmp
	MOVQ $0, d2src_off
	MOVQ (d2src)(d2src_off*1), src_tmp
	SUBQ $2, csrc_tmp
	MOVB -1(src_tmp)(len*1), src_val0

next_vect_1b:
	ADDQ $24, d2src_off
	MOVQ (d2src)(d2src_off*1), src_tmp
	MOVB -1(src_tmp)(len*1), src_val1
	XORB src_val1, src_val0
	SUBQ $1, csrc_tmp
	JGE  next_vect_1b

	MOVB  src_val0, -1(dst)(len*1)
	SUBQ  $1, len
	TESTQ $7, len
	JNZ   loop_1b

	CMPQ  len, $0
	JE    ret
	TESTQ $63, len
	JZ    aligned

not_aligned:
	TESTQ $7, len
	JNE   loop_1b
	MOVQ  len, not_aligned_len
	ANDQ  $63, not_aligned_len

loop_8b:
	MOVQ csrc, csrc_tmp
	MOVQ $0, d2src_off
	MOVQ (d2src)(d2src_off*1), src_tmp
	SUBQ $2, csrc_tmp
	MOVQ -8(src_tmp)(len*1), src_val0

next_vect_8b:
	ADDQ $24, d2src_off
	MOVQ (d2src)(d2src_off*1), src_tmp
	MOVQ -8(src_tmp)(len*1), src_val1
	XORQ src_val1, src_val0
	SUBQ $1, csrc_tmp
	JGE  next_vect_8b

	MOVQ src_val0, -8(dst)(len*1)
	SUBQ $8, len
	SUBQ $8, not_aligned_len
	JG   loop_8b

	CMPQ len, $64
	JGE  aligned
	RET

ret:
	RET