// File: DoubleString[P]RtConverter/src/Rtklib/rtkcmn.cpp
// Function: bamboo::ecef2pos(double const*, double*)
extern void ecef2pos(const double *r, double *pos)
{
    double e2=FE_WGS84*(2.0-FE_WGS84),r2=rtk_dot(r,r,2),z,zk,v=RE_WGS84,sinp;
    
    for (z=r[2],zk=0.0;fabs(z-zk)>=1E-4;) {
        zk=z;
        sinp=z/sqrt(r2+z*z);
        v=RE_WGS84/sqrt(1.0-e2*sinp*sinp);
        z=r[2]+v*e2*sinp;
    }
    pos[0]=r2>1E-12?atan(z/sqrt(r2)):(r[2]>0.0?pi/2.0:-pi/2.0);
    pos[1]=r2>1E-12?atan2(r[1],r[0]):0.0;
    pos[2]=sqrt(r2+z*z)-v;
}

// Assembly:
pushq %rbp
movq %rsp, %rbp
subq $0x60, %rsp
movq %rdi, -0x8(%rbp)
movq %rsi, -0x10(%rbp)
movsd 0x37890(%rip), %xmm0    # 0xc7428
movsd %xmm0, -0x18(%rbp)
movq -0x8(%rbp), %rdi
movq -0x8(%rbp), %rsi
movl $0x2, %edx
callq 0x8c7c0
movsd %xmm0, -0x20(%rbp)
movsd 0x2d28c(%rip), %xmm0    # 0xbce48
movsd %xmm0, -0x38(%rbp)
movq -0x8(%rbp), %rax
movsd 0x10(%rax), %xmm0
movsd %xmm0, -0x28(%rbp)
xorps %xmm0, %xmm0
movsd %xmm0, -0x30(%rbp)
movsd -0x28(%rbp), %xmm0
subsd -0x30(%rbp), %xmm0
movaps 0x2d638(%rip), %xmm1    # 0xbd220
pand %xmm1, %xmm0
movsd 0x2d274(%rip), %xmm1    # 0xbce68
ucomisd %xmm1, %xmm0
jb 0x8fcb8
movsd -0x28(%rbp), %xmm0
movsd %xmm0, -0x30(%rbp)
movsd -0x28(%rbp), %xmm0
movsd %xmm0, -0x48(%rbp)
movsd -0x20(%rbp), %xmm1
movsd -0x28(%rbp), %xmm0
movsd -0x28(%rbp), %xmm2
mulsd %xmm2, %xmm0
addsd %xmm1, %xmm0
callq 0x95e0
movaps %xmm0, %xmm1
movsd -0x48(%rbp), %xmm0
divsd %xmm1, %xmm0
movsd %xmm0, -0x40(%rbp)
movsd -0x18(%rbp), %xmm0
mulsd -0x40(%rbp), %xmm0
movsd -0x40(%rbp), %xmm1
movq %xmm0, %rax
movabsq $-0x8000000000000000, %rcx # imm = 0x8000000000000000
xorq %rcx, %rax
movq %rax, %xmm0
mulsd %xmm1, %xmm0
movsd 0x2c1ef(%rip), %xmm1    # 0xbbe60
addsd %xmm1, %xmm0
callq 0x95e0
movaps %xmm0, %xmm1
movsd 0x2d1c3(%rip), %xmm0    # 0xbce48
divsd %xmm1, %xmm0
movsd %xmm0, -0x38(%rbp)
movq -0x8(%rbp), %rax
movsd 0x10(%rax), %xmm1
movsd -0x38(%rbp), %xmm0
mulsd -0x18(%rbp), %xmm0
movsd -0x40(%rbp), %xmm2
mulsd %xmm2, %xmm0
addsd %xmm1, %xmm0
movsd %xmm0, -0x28(%rbp)
jmp 0x8fbd7
movsd -0x20(%rbp), %xmm0
movsd 0x3776b(%rip), %xmm1    # 0xc7430
ucomisd %xmm1, %xmm0
jbe 0x8fcf7
movsd -0x28(%rbp), %xmm0
movsd %xmm0, -0x58(%rbp)
movsd -0x20(%rbp), %xmm0
callq 0x95e0
movaps %xmm0, %xmm1
movsd -0x58(%rbp), %xmm0
divsd %xmm1, %xmm0
callq 0x9630
movsd %xmm0, -0x50(%rbp)
jmp 0x8fd2c
movq -0x8(%rbp), %rax
movsd 0x10(%rax), %xmm1
movsd 0x2d170(%rip), %xmm3    # 0xbce78
movsd 0x2d160(%rip), %xmm2    # 0xbce70
xorps %xmm0, %xmm0
cmpltsd %xmm1, %xmm0
movaps %xmm0, %xmm1
andpd %xmm3, %xmm1
andnpd %xmm2, %xmm0
orpd %xmm1, %xmm0
movsd %xmm0, -0x50(%rbp)
movsd -0x50(%rbp), %xmm0
movq -0x10(%rbp), %rax
movsd %xmm0, (%rax)
movsd -0x20(%rbp), %xmm0
movsd 0x376ea(%rip), %xmm1    # 0xc7430
ucomisd %xmm1, %xmm0
jbe 0x8fd69
movq -0x8(%rbp), %rax
movsd 0x8(%rax), %xmm0
movq -0x8(%rbp), %rax
movsd (%rax), %xmm1
callq 0x90f0
movsd %xmm0, -0x60(%rbp)
jmp 0x8fd73
xorps %xmm0, %xmm0
movsd %xmm0, -0x60(%rbp)
jmp 0x8fd73
movsd -0x60(%rbp), %xmm0
movq -0x10(%rbp), %rax
movsd %xmm0, 0x8(%rax)
movsd -0x20(%rbp), %xmm1
movsd -0x28(%rbp), %xmm0
movsd -0x28(%rbp), %xmm2
mulsd %xmm2, %xmm0
addsd %xmm1, %xmm0
callq 0x95e0
subsd -0x38(%rbp), %xmm0
movq -0x10(%rbp), %rax
movsd %xmm0, 0x10(%rax)
addq $0x60, %rsp
popq %rbp
retq
nopw %cs:(%rax,%rax)