// File: wrighteagle2d[P]wrighteaglebase/Debug/../src/InterceptModel.cpp
// Function: InterceptModel::CalcPeakPoint(Vector const&, double const&, double const&, double)
double InterceptModel::CalcPeakPoint(const Vector &relpos, const double &vp,
                                     const double &ka, const double fix) {
  static const double MINERROR = 0.01;

  const double alpha = ServerParam::instance().ballDecay();
  const double ln_alpha = ServerParam::instance().logBallDecay();
  const double x0 = relpos.X();
  const double y0 = relpos.Y();

  if (x0 < 0.0) {
    return 150.0;
  }

  if (fabs(y0) < ka) {
    return -1.0; //不可能穿越
  }

  double s, p, alpha_p, f, dfdx, last_f = 1000.0, x, last_x = x0;
  int iteration_cycle = 0;

  x = x0;
  do {
    iteration_cycle += 1;
    if (iteration_cycle > 10) {
      break;
    }
    s = Sqrt((x - x0) * (x - x0) + y0 * y0);
    p = (s - ka) / vp + fix;
    if (p < 0.0)
      p = 0.0;
    alpha_p = pow(alpha, (p));
    f = 1.0 - alpha_p * (1 - x * (x - x0) * ln_alpha / (s * vp));

    if (fabs(f) > fabs(last_f)) {
      return last_x; //没有切点
    } else {
      last_f = f;
    }
    last_x = x;
    dfdx =
        ln_alpha / vp *
        ((x - x0) * (f - 1.0) / s +
         alpha_p * ((x + x - x0) / s - x * (x - x0) * (x - x0) / (s * s * s)));
    dfdx = fabs(dfdx) < FLOAT_EPS ? (Sign(dfdx) * FLOAT_EPS) : dfdx;
    x = x - f / dfdx;
  } while (fabs(f) > MINERROR);

  return x;
}

// Assembly:
pushq %rbp
movq %rsp, %rbp
subq $0xb0, %rsp
movq %rdi, -0x10(%rbp)
movq %rsi, -0x18(%rbp)
movq %rdx, -0x20(%rbp)
movq %rcx, -0x28(%rbp)
movsd %xmm0, -0x30(%rbp)
callq 0x855e0
movq %rax, %rdi
callq 0x113d0
movsd (%rax), %xmm0
movsd %xmm0, -0x38(%rbp)
callq 0x855e0
movq %rax, %rdi
callq 0x4f340
movsd (%rax), %xmm0
movsd %xmm0, -0x40(%rbp)
movq -0x18(%rbp), %rdi
callq 0x176f0
movsd (%rax), %xmm0
movsd %xmm0, -0x48(%rbp)
movq -0x18(%rbp), %rdi
callq 0x17700
movsd (%rax), %xmm0
movsd %xmm0, -0x50(%rbp)
xorps %xmm0, %xmm0
ucomisd -0x48(%rbp), %xmm0
jbe 0x4e81c
movsd 0x73eee(%rip), %xmm0    # 0xc2700
movsd %xmm0, -0x8(%rbp)
jmp 0x4eb2f
movsd -0x50(%rbp), %xmm1
movaps 0x72838(%rip), %xmm0    # 0xc1060
pand %xmm0, %xmm1
movq -0x28(%rbp), %rax
movsd (%rax), %xmm0
ucomisd %xmm1, %xmm0
jbe 0x4e84c
movsd 0x72fe6(%rip), %xmm0    # 0xc1828
movsd %xmm0, -0x8(%rbp)
jmp 0x4eb2f
movsd 0x73e64(%rip), %xmm0    # 0xc26b8
movsd %xmm0, -0x80(%rbp)
movsd -0x48(%rbp), %xmm0
movsd %xmm0, -0x90(%rbp)
movl $0x0, -0x94(%rbp)
movsd -0x48(%rbp), %xmm0
movsd %xmm0, -0x88(%rbp)
movl -0x94(%rbp), %eax
addl $0x1, %eax
movl %eax, -0x94(%rbp)
cmpl $0xa, -0x94(%rbp)
jle 0x4e89a
jmp 0x4eb22
movsd -0x88(%rbp), %xmm0
subsd -0x48(%rbp), %xmm0
movsd -0x88(%rbp), %xmm2
subsd -0x48(%rbp), %xmm2
movsd -0x50(%rbp), %xmm1
mulsd -0x50(%rbp), %xmm1
mulsd %xmm2, %xmm0
addsd %xmm1, %xmm0
movsd %xmm0, -0xa0(%rbp)
leaq -0xa0(%rbp), %rdi
callq 0x12420
movsd %xmm0, -0x58(%rbp)
movsd -0x58(%rbp), %xmm0
movq -0x28(%rbp), %rax
subsd (%rax), %xmm0
movq -0x20(%rbp), %rax
divsd (%rax), %xmm0
addsd -0x30(%rbp), %xmm0
movsd %xmm0, -0x60(%rbp)
xorps %xmm0, %xmm0
ucomisd -0x60(%rbp), %xmm0
jbe 0x4e910
xorps %xmm0, %xmm0
movsd %xmm0, -0x60(%rbp)
movsd -0x38(%rbp), %xmm0
movsd -0x60(%rbp), %xmm1
callq 0xaa50
movsd %xmm0, -0x68(%rbp)
movsd -0x68(%rbp), %xmm0
movsd -0x88(%rbp), %xmm2
movsd -0x88(%rbp), %xmm1
subsd -0x48(%rbp), %xmm1
mulsd %xmm1, %xmm2
mulsd -0x40(%rbp), %xmm2
movsd -0x58(%rbp), %xmm1
movq -0x20(%rbp), %rax
mulsd (%rax), %xmm1
divsd %xmm1, %xmm2
movsd 0x726b0(%rip), %xmm1    # 0xc1010
subsd %xmm2, %xmm1
movq %xmm0, %rax
movabsq $-0x8000000000000000, %rcx # imm = 0x8000000000000000
xorq %rcx, %rax
movq %rax, %xmm0
mulsd %xmm1, %xmm0
movsd 0x72689(%rip), %xmm1    # 0xc1010
addsd %xmm1, %xmm0
movsd %xmm0, -0x70(%rbp)
movsd -0x70(%rbp), %xmm0
movaps 0x726c4(%rip), %xmm1    # 0xc1060
pand %xmm1, %xmm0
movsd -0x80(%rbp), %xmm1
movaps 0x726b4(%rip), %xmm2    # 0xc1060
pand %xmm2, %xmm1
ucomisd %xmm1, %xmm0
jbe 0x4e9c8
movsd -0x90(%rbp), %xmm0
movsd %xmm0, -0x8(%rbp)
jmp 0x4eb2f
movsd -0x70(%rbp), %xmm0
movsd %xmm0, -0x80(%rbp)
movsd -0x88(%rbp), %xmm0
movsd %xmm0, -0x90(%rbp)
movsd -0x40(%rbp), %xmm0
movq -0x20(%rbp), %rax
divsd (%rax), %xmm0
movsd -0x88(%rbp), %xmm2
subsd -0x48(%rbp), %xmm2
movsd -0x70(%rbp), %xmm1
movsd 0x72607(%rip), %xmm3    # 0xc1010
subsd %xmm3, %xmm1
mulsd %xmm1, %xmm2
divsd -0x58(%rbp), %xmm2
movsd -0x68(%rbp), %xmm1
movsd -0x88(%rbp), %xmm3
addsd -0x88(%rbp), %xmm3
subsd -0x48(%rbp), %xmm3
divsd -0x58(%rbp), %xmm3
movsd -0x88(%rbp), %xmm4
movsd -0x88(%rbp), %xmm5
subsd -0x48(%rbp), %xmm5
mulsd %xmm5, %xmm4
movsd -0x88(%rbp), %xmm5
subsd -0x48(%rbp), %xmm5
mulsd %xmm5, %xmm4
movsd -0x58(%rbp), %xmm5
mulsd -0x58(%rbp), %xmm5
mulsd -0x58(%rbp), %xmm5
divsd %xmm5, %xmm4
subsd %xmm4, %xmm3
mulsd %xmm3, %xmm1
addsd %xmm2, %xmm1
mulsd %xmm1, %xmm0
movsd %xmm0, -0x78(%rbp)
movsd -0x78(%rbp), %xmm1
movaps 0x725cd(%rip), %xmm0    # 0xc1060
pand %xmm0, %xmm1
movsd 0x72569(%rip), %xmm0    # 0xc1008
ucomisd %xmm1, %xmm0
jbe 0x4eac8
leaq -0x78(%rbp), %rdi
callq 0x1f2e0
cvtsi2sd %eax, %xmm0
movsd 0x7254e(%rip), %xmm1    # 0xc1008
mulsd %xmm1, %xmm0
movsd %xmm0, -0xa8(%rbp)
jmp 0x4ead5
movsd -0x78(%rbp), %xmm0
movsd %xmm0, -0xa8(%rbp)
movsd -0xa8(%rbp), %xmm0
movsd %xmm0, -0x78(%rbp)
movsd -0x88(%rbp), %xmm0
movsd -0x70(%rbp), %xmm1
divsd -0x78(%rbp), %xmm1
subsd %xmm1, %xmm0
movsd %xmm0, -0x88(%rbp)
movsd -0x70(%rbp), %xmm0
movaps 0x72554(%rip), %xmm1    # 0xc1060
pand %xmm1, %xmm0
movsd 0x72bb8(%rip), %xmm1    # 0xc16d0
ucomisd %xmm1, %xmm0
ja 0x4e87d
movsd -0x88(%rbp), %xmm0
movsd %xmm0, -0x8(%rbp)
movsd -0x8(%rbp), %xmm0
addq $0xb0, %rsp
popq %rbp
retq
nopl (%rax)