// File: /workspace/github_c_makefile_star2_O1/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 $0x48, %rsp
movq %rsi, 0x10(%rsp)
movq %rdx, 0x18(%rsp)
xorl %eax, %eax
movq %rax, 0x39d9b(%rip)     # 0x7aa30
movq %rax, 0x39d9c(%rip)     # 0x7aa38
movl %ecx, %r10d
testl %ecx, %ecx
jle 0x40ce1
xorpd %xmm0, %xmm0
xorl %eax, %eax
xorpd %xmm1, %xmm1
movss (%rdi,%rax,4), %xmm2
xorps %xmm3, %xmm3
cvtss2sd %xmm2, %xmm3
addsd %xmm3, %xmm0
mulss %xmm2, %xmm2
cvtss2sd %xmm2, %xmm2
addsd %xmm2, %xmm1
incq %rax
cmpq %rax, %r10
jne 0x40cad
movsd %xmm0, 0x39d57(%rip)    # 0x7aa30
movsd %xmm1, 0x39d57(%rip)    # 0x7aa38
movq 0x80(%rsp), %rax
xorps %xmm2, %xmm2
cvtsi2sd %ecx, %xmm2
movsd 0x39d38(%rip), %xmm0    # 0x7aa30
divsd %xmm2, %xmm0
movsd %xmm0, 0x39d2c(%rip)    # 0x7aa30
movsd 0x39d2c(%rip), %xmm1    # 0x7aa38
divsd %xmm2, %xmm1
movapd %xmm0, %xmm3
mulsd %xmm0, %xmm3
subsd %xmm3, %xmm1
movsd %xmm1, 0x39d14(%rip)    # 0x7aa38
movl $0x1, %r11d
leaq 0x39d0f(%rip), %rdx     # 0x7aa40
leaq 0x39d18(%rip), %rsi     # 0x7aa50
movsd 0x1bfc8(%rip), %xmm3    # 0x5cd08
leaq 0x39d19(%rip), %rbx     # 0x7aa60
movq 0x10(%rsp,%r11,8), %r14
xorpd %xmm5, %xmm5
xorpd %xmm4, %xmm4
testl %ecx, %ecx
jle 0x40d70
xorl %r15d, %r15d
xorps %xmm6, %xmm6
cvtss2sd (%r14,%r15,4), %xmm6
addsd %xmm6, %xmm4
incq %r15
cmpq %r15, %r10
jne 0x40d5b
divsd %xmm2, %xmm4
movsd %xmm4, (%rdx,%r11,8)
testl %ecx, %ecx
jle 0x40da1
xorpd %xmm5, %xmm5
xorl %r15d, %r15d
movss (%r14,%r15,4), %xmm6
mulss (%rdi,%r15,4), %xmm6
cvtss2sd %xmm6, %xmm6
addsd %xmm6, %xmm5
incq %r15
cmpq %r15, %r10
jne 0x40d85
divsd %xmm2, %xmm5
movapd %xmm4, %xmm6
mulsd %xmm0, %xmm6
subsd %xmm6, %xmm5
movsd %xmm5, (%rsi,%r11,8)
mulsd %xmm3, %xmm4
movl $0x1, %r12d
movq %r11, %r15
shlq $0x4, %r15
addq %rbx, %r15
testl %ecx, %ecx
jle 0x40df9
movq 0x10(%rsp,%r12,8), %r13
xorpd %xmm5, %xmm5
xorl %ebp, %ebp
movss (%r14,%rbp,4), %xmm6
mulss (%r13,%rbp,4), %xmm6
cvtss2sd %xmm6, %xmm6
addsd %xmm6, %xmm5
incq %rbp
cmpq %rbp, %r10
jne 0x40dda
jmp 0x40dfd
xorpd %xmm5, %xmm5
divsd %xmm2, %xmm5
movsd (%rdx,%r12,8), %xmm6
mulsd %xmm4, %xmm6
addsd %xmm5, %xmm6
movsd %xmm6, (%r15,%r12,8)
cmpq %r11, %r12
jbe 0x40e2b
movq %r12, %r13
shlq $0x4, %r13
addq %rbx, %r13
movsd %xmm6, (%r13,%r11,8)
leaq -0x1(%r12), %r13
cmpq %r11, %r12
movq %r13, %r12
ja 0x40dcb
subq $0x1, %r11
jae 0x40d47
movsd 0x39c16(%rip), %xmm2    # 0x7aa60
movsd 0x39c26(%rip), %xmm3    # 0x7aa78
movsd 0x39c0e(%rip), %xmm4    # 0x7aa68
movsd 0x39c0e(%rip), %xmm5    # 0x7aa70
movapd 0x10226(%rip), %xmm6    # 0x51090
movapd %xmm5, %xmm7
mulsd %xmm4, %xmm7
xorpd %xmm6, %xmm4
movapd %xmm2, %xmm8
mulsd %xmm3, %xmm8
subsd %xmm7, %xmm8
divsd %xmm8, %xmm3
leaq 0x20(%rsp), %rcx
movsd %xmm3, (%rcx)
divsd %xmm8, %xmm2
movsd %xmm2, 0x18(%rcx)
xorpd %xmm6, %xmm5
divsd %xmm8, %xmm5
movsd %xmm5, 0x8(%rcx)
divsd %xmm8, %xmm4
xorps %xmm2, %xmm2
cvtsd2ss %xmm0, %xmm2
movsd %xmm4, 0x10(%rcx)
movss %xmm2, (%rax)
xorpd %xmm0, %xmm0
xorl %edi, %edi
movq $0x0, (%rsp,%rdi,8)
xorl %r10d, %r10d
xorpd %xmm3, %xmm3
movsd (%rcx,%r10), %xmm4
mulsd (%r10,%rsi), %xmm4
addsd %xmm4, %xmm3
addq $0x8, %r10
cmpq $0x8, %r10
je 0x40ed5
movsd %xmm3, (%rsp,%rdi,8)
movsd (%rsi,%rdi,8), %xmm4
mulsd %xmm3, %xmm4
addsd %xmm4, %xmm0
mulsd (%rdx,%rdi,8), %xmm3
cvtss2sd %xmm2, %xmm2
subsd %xmm3, %xmm2
cvtsd2ss %xmm2, %xmm2
leaq 0x1(%rdi), %r10
addq $0x10, %rcx
testq %rdi, %rdi
movq %r10, %rdi
je 0x40ec6
movss %xmm2, (%rax)
xorps %xmm2, %xmm2
cvtsd2ss (%rsp), %xmm2
movss %xmm2, (%r8)
xorps %xmm2, %xmm2
cvtsd2ss 0x8(%rsp), %xmm2
movss %xmm2, (%r9)
divsd %xmm1, %xmm0
xorpd %xmm1, %xmm1
ucomisd %xmm1, %xmm0
jb 0x40f55
sqrtsd %xmm0, %xmm0
jmp 0x40f5a
callq 0x2290
cvtsd2ss %xmm0, %xmm0
addq $0x48, %rsp
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq