// File: /workspace/github_c_makefile_star2_O2/ToniWestbrook[P]paladin/ksw.c
// Function: ksw_u8
kswr_t ksw_u8(kswq_t *q, int tlen, const uint8_t *target, int _o_del, int _e_del, int _o_ins, int _e_ins, int xtra) // the first gap costs -(_o+_e)
{
	int slen, i, m_b, n_b, te = -1, gmax = 0, minsc, endsc;
	uint64_t *b;
	__m128i zero, oe_del, e_del, oe_ins, e_ins, shift, *H0, *H1, *E, *Hmax;
	kswr_t r;

#define __max_16(ret, xx) do { \
		(xx) = _mm_max_epu8((xx), _mm_srli_si128((xx), 8)); \
		(xx) = _mm_max_epu8((xx), _mm_srli_si128((xx), 4)); \
		(xx) = _mm_max_epu8((xx), _mm_srli_si128((xx), 2)); \
		(xx) = _mm_max_epu8((xx), _mm_srli_si128((xx), 1)); \
    	(ret) = _mm_extract_epi16((xx), 0) & 0x00ff; \
	} while (0)

	// initialization
	r = g_defr;
	minsc = (xtra&KSW_XSUBO)? xtra&0xffff : 0x10000;
	endsc = (xtra&KSW_XSTOP)? xtra&0xffff : 0x10000;
	m_b = n_b = 0; b = 0;
	zero = _mm_set1_epi32(0);
	oe_del = _mm_set1_epi8(_o_del + _e_del);
	e_del = _mm_set1_epi8(_e_del);
	oe_ins = _mm_set1_epi8(_o_ins + _e_ins);
	e_ins = _mm_set1_epi8(_e_ins);
	shift = _mm_set1_epi8(q->shift);
	H0 = q->H0; H1 = q->H1; E = q->E; Hmax = q->Hmax;
	slen = q->slen;
	for (i = 0; i < slen; ++i) {
		_mm_store_si128(E + i, zero);
		_mm_store_si128(H0 + i, zero);
		_mm_store_si128(Hmax + i, zero);
	}
	// the core loop
	for (i = 0; i < tlen; ++i) {
		int j, k, cmp, imax;
		__m128i e, h, t, f = zero, max = zero, *S = q->qp + target[i] * slen; // s is the 1st score vector
		h = _mm_load_si128(H0 + slen - 1); // h={2,5,8,11,14,17,-1,-1} in the above example
		h = _mm_slli_si128(h, 1); // h=H(i-1,-1); << instead of >> because x64 is little-endian
		for (j = 0; LIKELY(j < slen); ++j) {
			/* SW cells are computed in the following order:
			 *   H(i,j)   = max{H(i-1,j-1)+S(i,j), E(i,j), F(i,j)}
			 *   E(i+1,j) = max{H(i,j)-q, E(i,j)-r}
			 *   F(i,j+1) = max{H(i,j)-q, F(i,j)-r}
			 */
			// compute H'(i,j); note that at the beginning, h=H'(i-1,j-1)
			h = _mm_adds_epu8(h, _mm_load_si128(S + j));
			h = _mm_subs_epu8(h, shift); // h=H'(i-1,j-1)+S(i,j)
			e = _mm_load_si128(E + j); // e=E'(i,j)
			h = _mm_max_epu8(h, e);
			h = _mm_max_epu8(h, f); // h=H'(i,j)
			max = _mm_max_epu8(max, h); // set max
			_mm_store_si128(H1 + j, h); // save to H'(i,j)
			// now compute E'(i+1,j)
			e = _mm_subs_epu8(e, e_del); // e=E'(i,j) - e_del
			t = _mm_subs_epu8(h, oe_del); // h=H'(i,j) - o_del - e_del
			e = _mm_max_epu8(e, t); // e=E'(i+1,j)
			_mm_store_si128(E + j, e); // save to E'(i+1,j)
			// now compute F'(i,j+1)
			f = _mm_subs_epu8(f, e_ins);
			t = _mm_subs_epu8(h, oe_ins); // h=H'(i,j) - o_ins - e_ins
			f = _mm_max_epu8(f, t);
			// get H'(i-1,j) and prepare for the next j
			h = _mm_load_si128(H0 + j); // h=H'(i-1,j)
		}
		// NB: we do not need to set E(i,j) as we disallow adjecent insertion and then deletion
		for (k = 0; LIKELY(k < 16); ++k) { // this block mimics SWPS3; NB: H(i,j) updated in the lazy-F loop cannot exceed max
			f = _mm_slli_si128(f, 1);
			for (j = 0; LIKELY(j < slen); ++j) {
				h = _mm_load_si128(H1 + j);
				h = _mm_max_epu8(h, f); // h=H'(i,j)
				_mm_store_si128(H1 + j, h);
				h = _mm_subs_epu8(h, oe_ins);
				f = _mm_subs_epu8(f, e_ins);
				cmp = _mm_movemask_epi8(_mm_cmpeq_epi8(_mm_subs_epu8(f, h), zero));
				if (UNLIKELY(cmp == 0xffff)) goto end_loop16;
			}
		}
end_loop16:
		//int k;for (k=0;k<16;++k)printf("%d ", ((uint8_t*)&max)[k]);printf("\n");
		__max_16(imax, max); // imax is the maximum number in max
		if (imax >= minsc) { // write the b array; this condition adds branching unfornately
			if (n_b == 0 || (int32_t)b[n_b-1] + 1 != i) { // then append
				if (n_b == m_b) {
					m_b = m_b? m_b<<1 : 8;
					b = (uint64_t*)realloc(b, 8 * m_b);
				}
				b[n_b++] = (uint64_t)imax<<32 | i;
			} else if ((int)(b[n_b-1]>>32) < imax) b[n_b-1] = (uint64_t)imax<<32 | i; // modify the last
		}
		if (imax > gmax) {
			gmax = imax; te = i; // te is the end position on the target
			for (j = 0; LIKELY(j < slen); ++j) // keep the H1 vector
				_mm_store_si128(Hmax + j, _mm_load_si128(H1 + j));
			if (gmax + q->shift >= 255 || gmax >= endsc) break;
		}
		S = H1; H1 = H0; H0 = S; // swap H0 and H1
	}
	r.score = gmax + q->shift < 255? gmax : 255;
	r.te = te;
	if (r.score != 255) { // get a->qe, the end of query match; find the 2nd best score
		int max = -1, tmp, low, high, qlen = slen * 16;
		uint8_t *t = (uint8_t*)Hmax;
		for (i = 0; i < qlen; ++i, ++t)
			if ((int)*t > max) max = *t, r.qe = i / 16 + i % 16 * slen;
			else if ((int)*t == max && (tmp = i / 16 + i % 16 * slen) < r.qe) r.qe = tmp; 
		//printf("%d,%d\n", max, gmax);
		if (b) {
			i = (r.score + q->max - 1) / q->max;
			low = te - i; high = te + i;
			for (i = 0; i < n_b; ++i) {
				int e = (int32_t)b[i];
				if ((e < low || e > high) && (int)(b[i]>>32) > r.score2)
					r.score2 = b[i]>>32, r.te2 = e;
			}
		}
	}
	free(b);
	return r;
}

// Assembly:
pushq %rbp
pushq %r15
pushq %r14
pushq %r13
pushq %r12
pushq %rbx
subq $0xc8, %rsp
movq %rcx, 0x30(%rsp)
movl 0x108(%rsp), %eax
movups 0x6306(%rip), %xmm0     # 0x246b8
movups %xmm0, 0xc(%rdi)
movups 0x62ef(%rip), %xmm0     # 0x246ac
movq %rdi, 0x40(%rsp)
movups %xmm0, (%rdi)
addl %r9d, %r8d
movd %r8d, %xmm4
movd %r9d, %xmm2
movd %eax, %xmm0
addl 0x100(%rsp), %eax
movd %eax, %xmm3
movd 0x8(%rsi), %xmm1
movq 0x18(%rsi), %rbx
movq 0x20(%rsi), %rax
movq 0x28(%rsi), %r14
movq 0x30(%rsi), %r13
movq %rsi, 0x18(%rsp)
movslq 0x4(%rsi), %r11
xorl %ecx, %ecx
testl %r11d, %r11d
movl $0x0, %r15d
cmovgl %r11d, %r15d
shlq $0x4, %r15
xorps %xmm5, %xmm5
cmpq %rcx, %r15
je 0x1e42f
movaps %xmm5, (%r14,%rcx)
movaps %xmm5, (%rbx,%rcx)
movaps %xmm5, (%r13,%rcx)
addq $0x10, %rcx
jmp 0x1e415
movl 0x110(%rsp), %ecx
movzwl %cx, %ecx
movl %ecx, 0x14(%rsp)
punpcklbw %xmm4, %xmm4    # xmm4 = xmm4[0,0,1,1,2,2,3,3,4,4,5,5,6,6,7,7]
pshuflw $0x0, %xmm4, %xmm4      # xmm4 = xmm4[0,0,0,0,4,5,6,7]
pshufd $0x0, %xmm4, %xmm5      # xmm5 = xmm4[0,0,0,0]
punpcklbw %xmm2, %xmm2    # xmm2 = xmm2[0,0,1,1,2,2,3,3,4,4,5,5,6,6,7,7]
pshuflw $0x0, %xmm2, %xmm2      # xmm2 = xmm2[0,0,0,0,4,5,6,7]
pshufd $0x0, %xmm2, %xmm6      # xmm6 = xmm2[0,0,0,0]
punpcklbw %xmm3, %xmm3    # xmm3 = xmm3[0,0,1,1,2,2,3,3,4,4,5,5,6,6,7,7]
pshuflw $0x0, %xmm3, %xmm2      # xmm2 = xmm3[0,0,0,0,4,5,6,7]
pshufd $0x0, %xmm2, %xmm7      # xmm7 = xmm2[0,0,0,0]
punpcklbw %xmm0, %xmm0    # xmm0 = xmm0[0,0,1,1,2,2,3,3,4,4,5,5,6,6,7,7]
pshuflw $0x0, %xmm0, %xmm0      # xmm0 = xmm0[0,0,0,0,4,5,6,7]
pshufd $0x0, %xmm0, %xmm8      # xmm8 = xmm0[0,0,0,0]
punpcklbw %xmm1, %xmm1    # xmm1 = xmm1[0,0,1,1,2,2,3,3,4,4,5,5,6,6,7,7]
pshuflw $0x0, %xmm1, %xmm0      # xmm0 = xmm1[0,0,0,0,4,5,6,7]
xorl %esi, %esi
testl %edx, %edx
cmovlel %esi, %edx
movq %rdx, 0x68(%rsp)
pshufd $0x0, %xmm0, %xmm9      # xmm9 = xmm0[0,0,0,0]
leaq 0x10(%r15), %r12
pushq $-0x1
popq %rcx
movl %ecx, 0x10(%rsp)
movq %r11, %rcx
shlq $0x4, %rcx
movq %rcx, 0x60(%rsp)
movq $0x0, 0x8(%rsp)
xorl %r8d, %r8d
xorl %r9d, %r9d
movq $0x0, 0x38(%rsp)
movq 0x30(%rsp), %rdi
movq %r11, 0x48(%rsp)
movdqa %xmm5, 0xb0(%rsp)
movdqa %xmm6, 0xa0(%rsp)
movdqa %xmm7, 0x90(%rsp)
movdqa %xmm8, 0x80(%rsp)
movdqa %xmm9, 0x70(%rsp)
cmpq 0x68(%rsp), %rsi
je 0x1e7c1
movq %rax, %rbp
movzbl (%rdi,%rsi), %eax
imull %r11d, %eax
cltq
shlq $0x4, %rax
movq 0x18(%rsp), %rcx
addq 0x10(%rcx), %rax
movq 0x60(%rsp), %rcx
movdqa -0x10(%rbx,%rcx), %xmm2
pslldq $0x1, %xmm2             # xmm2 = zero,xmm2[0,1,2,3,4,5,6,7,8,9,10,11,12,13,14]
pxor %xmm1, %xmm1
xorl %ecx, %ecx
pxor %xmm0, %xmm0
cmpq %rcx, %r15
je 0x1e58e
paddusb (%rax,%rcx), %xmm2
psubusb %xmm9, %xmm2
movdqa (%r14,%rcx), %xmm3
movdqa %xmm3, %xmm4
pmaxub %xmm1, %xmm4
pmaxub %xmm2, %xmm4
pmaxub %xmm4, %xmm0
movdqa %xmm4, (%rbp,%rcx)
psubusb %xmm6, %xmm3
movdqa %xmm4, %xmm2
psubusb %xmm5, %xmm2
pmaxub %xmm3, %xmm2
movdqa %xmm2, (%r14,%rcx)
psubusb %xmm8, %xmm1
psubusb %xmm7, %xmm4
pmaxub %xmm4, %xmm1
movdqa (%rbx,%rcx), %xmm2
addq $0x10, %rcx
jmp 0x1e535
movq %rsi, 0x20(%rsp)
movq %r8, 0x28(%rsp)
xorl %eax, %eax
cmpl $0x10, %eax
je 0x1e5e5
pslldq $0x1, %xmm1             # xmm1 = zero,xmm1[0,1,2,3,4,5,6,7,8,9,10,11,12,13,14]
xorl %edx, %edx
leaq 0x10(%rdx), %rcx
cmpq %rcx, %r12
je 0x1e5e1
movdqa (%rbp,%rdx), %xmm2
pmaxub %xmm1, %xmm2
movdqa %xmm2, (%rbp,%rdx)
psubusb %xmm7, %xmm2
psubusb %xmm8, %xmm1
pminub %xmm1, %xmm2
pcmpeqb %xmm1, %xmm2
pmovmskb %xmm2, %esi
movq %rcx, %rdx
cmpl $0xffff, %esi           # imm = 0xFFFF
jne 0x1e5a6
jmp 0x1e5e5
incl %eax
jmp 0x1e59a
btl $0x12, 0x110(%rsp)
movdqa %xmm0, %xmm1
psrldq $0x8, %xmm1             # xmm1 = xmm1[8,9,10,11,12,13,14,15],zero,zero,zero,zero,zero,zero,zero,zero
pmaxub %xmm0, %xmm1
movdqa %xmm1, %xmm0
psrldq $0x4, %xmm0             # xmm0 = xmm0[4,5,6,7,8,9,10,11,12,13,14,15],zero,zero,zero,zero
pmaxub %xmm1, %xmm0
movdqa %xmm0, %xmm1
psrldq $0x2, %xmm1             # xmm1 = xmm1[2,3,4,5,6,7,8,9,10,11,12,13,14,15],zero,zero
pmaxub %xmm0, %xmm1
movdqa %xmm1, %xmm0
psrldq $0x1, %xmm0             # xmm0 = xmm0[1,2,3,4,5,6,7,8,9,10,11,12,13,14,15],zero
pmaxub %xmm1, %xmm0
movd %xmm0, %eax
movzbl %al, %ecx
jae 0x1e729
cmpl %ecx, 0x14(%rsp)
movq 0x28(%rsp), %r8
movq 0x20(%rsp), %rsi
ja 0x1e75b
movslq %r9d, %r10
testl %r9d, %r9d
je 0x1e68a
movq 0x8(%rsp), %rax
movq -0x8(%rax,%r10,8), %rax
movq %rcx, %rdx
leal 0x1(%rax), %ecx
cmpq %rsi, %rcx
movq %rdx, %rcx
jne 0x1e68a
shrq $0x20, %rax
cmpl %ecx, %eax
jge 0x1e75b
decq %r10
movq %rcx, %rax
shlq $0x20, %rax
orq %rsi, %rax
movq 0x8(%rsp), %rdx
movq %rax, (%rdx,%r10,8)
jmp 0x1e75b
movq %r10, 0x58(%rsp)
cmpl 0x38(%rsp), %r9d
jne 0x1e735
movq %rcx, 0x50(%rsp)
leal (%r9,%r9), %ecx
testl %r9d, %r9d
pushq $0x8
popq %rax
cmovel %eax, %ecx
movq %rcx, 0x38(%rsp)
leal (,%rcx,8), %eax
movslq %eax, %rsi
movq 0x8(%rsp), %rdi
leaq 0x6001(%rip), %rdx      # 0x246c8
movl $0xc5, %ecx
leaq 0x6005(%rip), %r8       # 0x246d8
movq %r9, 0x8(%rsp)
callq 0x1e0b4
movq 0x50(%rsp), %rcx
movdqa 0x70(%rsp), %xmm9
movdqa 0x80(%rsp), %xmm8
movq 0x20(%rsp), %rsi
movdqa 0x90(%rsp), %xmm7
movdqa 0xa0(%rsp), %xmm6
movdqa 0xb0(%rsp), %xmm5
movq 0x28(%rsp), %r8
movq 0x30(%rsp), %r10
movq 0x8(%rsp), %r9
movq 0x48(%rsp), %r11
jmp 0x1e73d
movq 0x28(%rsp), %r8
movq 0x20(%rsp), %rsi
jmp 0x1e75b
movq %rdi, %r10
movq 0x8(%rsp), %rax
movq %rcx, %rdi
shlq $0x20, %rdi
orq %rsi, %rdi
incl %r9d
movq %rax, 0x8(%rsp)
movq 0x58(%rsp), %rdx
movq %rdi, (%rax,%rdx,8)
movq %r10, %rdi
cmpl %ecx, %r8d
jae 0x1e7b3
xorl %eax, %eax
cmpq %rax, %r15
je 0x1e77a
movdqa (%rbp,%rax), %xmm0
movdqa %xmm0, (%r13,%rax)
addq $0x10, %rax
jmp 0x1e762
cmpl %ecx, 0x14(%rsp)
movq %rcx, %rdx
seta %cl
btl $0x11, 0x110(%rsp)
setae %r8b
movq 0x18(%rsp), %rax
movzbl 0x8(%rax), %eax
addl %edx, %eax
orb %cl, %r8b
cmpb $0x1, %r8b
jne 0x1e7d3
movl %edx, %r8d
movl %esi, 0x10(%rsp)
cmpl $0xfe, %eax
ja 0x1e7d3
incq %rsi
movq %rbx, %rax
movq %rbp, %rbx
jmp 0x1e4f6
movq 0x18(%rsp), %rax
movzbl 0x8(%rax), %eax
addl %r8d, %eax
movl 0x10(%rsp), %ebp
jmp 0x1e7d8
movl %edx, %r8d
movl %esi, %ebp
movl $0xff, %ecx
cmpl %ecx, %eax
cmovgel %ecx, %r8d
movq 0x40(%rsp), %r14
movl %r8d, (%r14)
movl %ebp, 0x4(%r14)
cmpl %ecx, %r8d
movq 0x8(%rsp), %rdi
je 0x1e8e4
movq %r8, %r15
movl %r11d, %eax
shll $0x4, %eax
movl 0x8(%r14), %edx
xorl %ecx, %ecx
testl %eax, %eax
cmovlel %ecx, %eax
pushq $-0x1
popq %rsi
cmpl %ecx, %eax
je 0x1e864
movzbl (%r13,%rcx), %r8d
cmpl %r8d, %esi
jge 0x1e835
movl %ecx, %esi
shrl $0x4, %esi
movl %ecx, %edx
andl $0xf, %edx
imull %r11d, %edx
addl %esi, %edx
jmp 0x1e85c
jne 0x1e859
movl %ecx, %r8d
shrl $0x4, %r8d
movq %r9, %rbx
movl %ecx, %r9d
andl $0xf, %r9d
imull %r11d, %r9d
addl %r8d, %r9d
cmpl %edx, %r9d
cmovll %r9d, %edx
movq %rbx, %r9
movl %esi, %r8d
incq %rcx
movl %r8d, %esi
jmp 0x1e814
movl %edx, 0x8(%r14)
testq %rdi, %rdi
je 0x1e8e4
movq 0x18(%rsp), %rax
movzbl 0xa(%rax), %ecx
leal (%r15,%rcx), %eax
decl %eax
cltd
idivl %ecx
movl %ebp, %ecx
subl %eax, %ecx
addl %ebp, %eax
movl 0xc(%r14), %r8d
movl 0x10(%r14), %edx
xorl %esi, %esi
testl %r9d, %r9d
cmovlel %esi, %r9d
cmpq %rsi, %r9
je 0x1e8dc
movq %r9, %r15
movq (%rdi,%rsi,8), %r9
cmpl %r9d, %ecx
setg %r10b
cmpl %r9d, %eax
setl %r11b
orb %r10b, %r11b
movq %r9, %r10
shrq $0x20, %r10
cmpl %r10d, %r8d
cmovgl %r8d, %r10d
movl %edx, %ebx
cmovll %r9d, %ebx
movq %r15, %r9
testb %r11b, %r11b
cmovnel %ebx, %edx
cmovel %r8d, %r10d
incq %rsi
movl %r10d, %r8d
jmp 0x1e896
movl %r8d, 0xc(%r14)
movl %edx, 0x10(%r14)
callq 0x3390
movq %r14, %rax
addq $0xc8, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq