// File: /workspace/github_c_makefile_star2_O3/ugobas[P]tnm/Fit.c
// Function: Fit_2
float Fit_2(float *Y, float *X0, float *X1, int N,
	    float *A0, float *A1, float *bias, int first)
{
  float mu1=0;
  // 0: do not allow offset 1: do not penalize offset 0.5: penalize

  // Fit Y=XA with X=(2*n) setting bias b=0
  // and evaluating it as b=<Y>-<X>A
  // A=<X^T X>^{-1}<X^T Y>
  float *x[2]; x[0]=X0; x[1]=X1;
  int amax=0, a, b, i;
  if(1){ // Compute also for variable X1, which is the same at all calls
    amax=1;
    Y1=0; Y2=0; for(i=0; i<N; i++){Y1+=Y[i]; Y2+=Y[i]*Y[i];}
    Y1/=N; Y2=(Y2/N-Y1*Y1); 
  }


  for(a=amax; a>=0; a--){
    float *xa=x[a];
    double s=0; for(i=0; i<N; i++){s+=xa[i];} X_ave[a]=s/N;
    //s=0; for(i=0; i<N; i++){s+=xa[i]*xa[i];}
    //X_dev[a]=sqrt(s/N-X_ave[a]*X_ave[a]);
    s=0; for(i=0; i<N; i++){s+=xa[i]*Y[i];}
    corr_y[a]=s/N-X_ave[a]*Y1;
    for(b=1; b>=a; b--){
      float *xb=x[b];
      s=0; for(i=0; i<N; i++){s+=xa[i]*xb[i];}
      Corr[a][b]=s/N-mu1*X_ave[a]*X_ave[b];
      if(b>a)Corr[b][a]=Corr[a][b];
    }
  }

  double Corr_inv[2][2];
  double det=Corr[0][0]*Corr[1][1]-Corr[0][1]*Corr[1][0];
  Corr_inv[0][0]=Corr[1][1]/det;
  Corr_inv[1][1]=Corr[0][0]/det;
  Corr_inv[0][1]=-Corr[1][0]/det;
  Corr_inv[1][0]=-Corr[0][1]/det;

  double A[2], r2=0; *bias=Y1;
  for(a=0; a<2; a++){
    A[a]=0; for(b=0; b<2; b++)A[a]+=Corr_inv[a][b]*corr_y[b];
    r2+=A[a]*corr_y[a];
    (*bias)-=X_ave[a]*A[a];
  }
  *A0=A[0];
  *A1=A[1];

  return(sqrt(r2/Y2));
}

// Assembly:
pushq %rbp
pushq %r15
pushq %r14
pushq %r13
pushq %r12
pushq %rbx
subq $0x58, %rsp
movq %rsi, 0x10(%rsp)
movq %rdx, 0x18(%rsp)
movl %ecx, %r10d
xorpd %xmm1, %xmm1
testl %ecx, %ecx
jle 0x40c7b
xorl %eax, %eax
movss (%rdi,%rax,4), %xmm0
movaps %xmm0, %xmm2
mulss %xmm0, %xmm2
unpcklps %xmm0, %xmm2            # xmm2 = xmm2[0],xmm0[0],xmm2[1],xmm0[1]
cvtps2pd %xmm2, %xmm0
addpd %xmm0, %xmm1
incq %rax
cmpq %rax, %r10
jne 0x40c5d
movq 0x90(%rsp), %rax
xorps %xmm2, %xmm2
cvtsi2sd %ecx, %xmm2
movapd %xmm1, %xmm0
unpckhpd %xmm1, %xmm0            # xmm0 = xmm0[1],xmm1[1]
divsd %xmm2, %xmm0
movsd %xmm0, 0x39d82(%rip)    # 0x7aa20
divsd %xmm2, %xmm1
movapd %xmm0, %xmm3
mulsd %xmm0, %xmm3
subsd %xmm3, %xmm1
movsd %xmm1, 0x39d72(%rip)    # 0x7aa28
xorpd %xmm3, %xmm3
divsd %xmm2, %xmm3
movl $0x1, %r11d
leaq 0x39d65(%rip), %rdx     # 0x7aa30
leaq 0x39d6e(%rip), %rsi     # 0x7aa40
movsd 0x1bfee(%rip), %xmm4    # 0x5ccc8
leaq 0x39d6f(%rip), %rbx     # 0x7aa50
movq 0x10(%rsp,%r11,8), %r14
testl %ecx, %ecx
jle 0x40d39
xorpd %xmm5, %xmm5
xorl %r15d, %r15d
xorps %xmm6, %xmm6
cvtss2sd (%r14,%r15,4), %xmm6
addsd %xmm6, %xmm5
incq %r15
cmpq %r15, %r10
jne 0x40cf1
divsd %xmm2, %xmm5
movsd %xmm5, (%rdx,%r11,8)
xorpd %xmm6, %xmm6
testl %ecx, %ecx
jle 0x40d47
xorl %r15d, %r15d
movss (%r14,%r15,4), %xmm7
mulss (%rdi,%r15,4), %xmm7
cvtss2sd %xmm7, %xmm7
addsd %xmm7, %xmm6
incq %r15
cmpq %r15, %r10
jne 0x40d1b
jmp 0x40d47
movsd %xmm3, (%rdx,%r11,8)
xorpd %xmm6, %xmm6
movapd %xmm3, %xmm5
divsd %xmm2, %xmm6
movapd %xmm5, %xmm7
mulsd %xmm0, %xmm7
subsd %xmm7, %xmm6
movsd %xmm6, (%rsi,%r11,8)
mulsd %xmm4, %xmm5
movl $0x1, %r15d
movq %r11, %r12
shlq $0x4, %r12
addq %rbx, %r12
testl %ecx, %ecx
jle 0x40d9f
movq 0x10(%rsp,%r15,8), %r13
xorpd %xmm6, %xmm6
xorl %ebp, %ebp
movss (%r14,%rbp,4), %xmm7
mulss (%r13,%rbp,4), %xmm7
cvtss2sd %xmm7, %xmm7
addsd %xmm7, %xmm6
incq %rbp
cmpq %rbp, %r10
jne 0x40d80
jmp 0x40da3
xorpd %xmm6, %xmm6
divsd %xmm2, %xmm6
movsd (%rdx,%r15,8), %xmm7
mulsd %xmm5, %xmm7
addsd %xmm6, %xmm7
movsd %xmm7, (%r12,%r15,8)
cmpq %r11, %r15
jbe 0x40dd6
movq %r15, %r13
shlq $0x4, %r13
addq %rbx, %r13
movsd %xmm7, (%r13,%r11,8)
decq %r15
jmp 0x40d71
subq $0x1, %r11
jae 0x40ce1
movsd 0x39c68(%rip), %xmm2    # 0x7aa50
movsd 0x39c78(%rip), %xmm3    # 0x7aa68
movsd 0x39c60(%rip), %xmm4    # 0x7aa58
movsd 0x39c60(%rip), %xmm5    # 0x7aa60
movapd 0x10288(%rip), %xmm6    # 0x51090
movapd %xmm5, %xmm7
mulsd %xmm4, %xmm7
xorpd %xmm6, %xmm4
unpcklpd %xmm2, %xmm4            # xmm4 = xmm4[0],xmm2[0]
mulsd %xmm3, %xmm2
subsd %xmm7, %xmm2
xorpd %xmm6, %xmm5
unpcklpd %xmm5, %xmm3            # xmm3 = xmm3[0],xmm5[0]
unpcklpd %xmm2, %xmm2            # xmm2 = xmm2[0,0]
divpd %xmm2, %xmm3
movapd %xmm3, 0x30(%rsp)
divpd %xmm2, %xmm4
movapd %xmm4, 0x40(%rsp)
xorps %xmm2, %xmm2
cvtsd2ss %xmm0, %xmm2
xorpd %xmm0, %xmm0
movq %rsp, %r11
movb $0x1, %cl
xorl %r10d, %r10d
leaq 0x28(%rsp), %rdi
movq %r10, %rbx
shlq $0x4, %rbx
addq %rsp, %rbx
addq $0x30, %rbx
movb $0x1, %bpl
xorl %r14d, %r14d
xorpd %xmm3, %xmm3
movsd (%rbx,%r14,8), %xmm4
mulsd (%rsi,%r14,8), %xmm4
addsd %xmm4, %xmm3
movl $0x1, %r14d
testb $0x1, %bpl
movl $0x0, %ebp
jne 0x40e70
movsd %xmm3, (%r11)
movsd (%rsi,%r10,8), %xmm4
mulsd %xmm3, %xmm4
addsd %xmm4, %xmm0
mulsd (%rdx,%r10,8), %xmm3
cvtss2sd %xmm2, %xmm2
subsd %xmm3, %xmm2
cvtsd2ss %xmm2, %xmm2
movl $0x1, %r10d
movq %rdi, %r11
testb $0x1, %cl
movl $0x0, %ecx
jne 0x40e58
movss %xmm2, (%rax)
xorps %xmm2, %xmm2
cvtsd2ss (%rsp), %xmm2
movss %xmm2, (%r8)
xorps %xmm2, %xmm2
cvtsd2ss 0x28(%rsp), %xmm2
movss %xmm2, (%r9)
divsd %xmm1, %xmm0
xorpd %xmm1, %xmm1
ucomisd %xmm1, %xmm0
jb 0x40efc
sqrtsd %xmm0, %xmm0
jmp 0x40f01
callq 0x22a0
cvtsd2ss %xmm0, %xmm0
addq $0x58, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq