// File: /workspace/github_cpp_makefile_star2_O2/DoubleString[P]RtConverter/src/Rnxbrd/BroadcastEphUtils.cpp
// Function: bamboo::BroadcastEphUtils::m_brd2xyz(char const*, char const*, int, double, double*, double*, double*, double*, int*)
int BroadcastEphUtils::m_brd2xyz(const char* mode,const char* cprn,int wk,double sow,double* xsat,double* clk,double* dtmin,double* tgd,int* iode){
	int i,isys,lfind;
	double GMEARTH, EARTH_ROTATE;
	double dt, dtc, pos[3], svpos[3], geovel[3], detavel[3];
	double a, xn, xm, ex, e, v0, vs, vc, phi, ccc, sss, du, dr, di, r, u, xi,
			xx, yy,intv;
	double xnode, xpdot, ypdot, asc, xinc, xp, yp, asctrm, v;
	double edot, cosf2, cose2, nudot, rdot, udot, idot;
	list<GPSEPH>::iterator gpsItr;
	GPSEPH* eph;
	intv = 2.0;
	switch (cprn[0]) {
	case 'G':
		GMEARTH = 3.986005E14;
		EARTH_ROTATE = 7.2921151467E-5;
		break;
	case 'E':
		GMEARTH = 3.986004418E14;
		EARTH_ROTATE = 7.2921151467E-5;
		break;
	case 'C':
		GMEARTH = 3.986004418E14;
		EARTH_ROTATE = 7.2921150E-5;
		break;
	case 'J':
		GMEARTH = 3.986005E14;
		EARTH_ROTATE = 7.2921150E-5;
		break;
	default:
		GMEARTH = GME;
		EARTH_ROTATE = E_ROTATE;
		break;
	}
	lfind = 0;
	*clk = 0;
	*dtmin = 8.0;
	isys = index_string(SYS,cprn[0]);
	double tmax = 0.0,ttag;
	for(gpsItr = this->gnssEph[isys].begin();gpsItr != this->gnssEph[isys].end();++gpsItr){
		if(strstr((*gpsItr).cprn,cprn)){
			dt = (wk - (*gpsItr).week) * 168.0
							+ (sow - (*gpsItr).toe) / 3600.0;
			if (*iode >= 0) {
				if ((*gpsItr).aode == *iode) {
					*dtmin = fabs(dt);
					eph = &(*gpsItr);
					lfind = 1;
					break;
				}
			} else if(*iode == -1){
				if (fabs(dt) <= *dtmin) {
					*dtmin = fabs(dt);
					eph = &(*gpsItr);
					lfind = 1;
				}
			} else if(*iode == -2){
				ttag = (*gpsItr).mjd * 86400.0 + (*gpsItr).sod;
				// For the real-time process : always the newest
				if (ttag > tmax && fabs(dt) <= intv) {
					tmax = ttag;
					*dtmin = fabs(dt);
					lfind = 1;
					eph = &(*gpsItr);
				}
			}
		}
	}
	if(lfind == 0)
		return 0;
	*iode = eph->aode;
	dt = (wk - eph->week) * 604800.0 + sow - eph->toe;
	dtc = (wk * 7 + 44244 - eph->mjd) * 86400.0 + sow - eph->sod;

	*clk = eph->a0 + (eph->a1 + eph->a2 * dtc) * dtc;
	*tgd = eph->tgd;
//	if(cprn[0] == 'C'){
//		// change the broadcast sclock into L2/L5
//		r_bds=(BDS_B1*BDS_B1)/(BDS_B2*BDS_B2);
//		*clk=*clk-r_bds/(r_bds-1)*eph->tgd+1/(r_bds-1)*eph->tgd1;
//	}
	if (strstr(mode, "ynn") != NULL)
		return 1;
	a = eph->roota * eph->roota;
	xn = sqrt(GMEARTH / a / a / a);
	xn = xn + eph->dn;
	xm = eph->m0 + xn * dt;
	ex = xm;
	e = eph->e;
	for (i = 0; i < 12; i++)
		ex = xm + e * sin(ex);
	v0 = 1.0 - e * cos(ex);
	vs = sqrt(1.0 - e * e) * sin(ex) / v0;
	vc = (cos(ex) - e) / v0;
	v = fabs(asin(vs));
	// decide vs
	if (vc >= 0) {
		if (vs < 0)
			v = 2.0 * PI - v;
	} else {
		if (vs <= 0)
			v = PI + v;
		else
			v = PI - v;
	}

	phi = v + eph->omega;
	ccc = cos(2.0 * phi);
	sss = sin(2.0 * phi);
	du = eph->cuc * ccc + eph->cus * sss;
	dr = eph->crc * ccc + eph->crs * sss;
	di = eph->cic * ccc + eph->cis * sss;
	r = a * (1.0 - e * cos(ex)) + dr;
	u = phi + du;

	xi = eph->i0 + eph->idot * dt + di;
	xx = r * cos(u);
	yy = r * sin(u);

	if (strstr(cprn, "C01") != NULL || strstr(cprn, "C02") != NULL
			|| strstr(cprn, "C03") != NULL || strstr(cprn, "C04") != NULL
			|| strstr(cprn, "C05") != NULL) {
		xnode = eph->omega0  + eph->omegadot * dt;
	} else {
		xnode = eph->omega0 + (eph->omegadot - EARTH_ROTATE) * dt;
	}

	//IF THE TIME SYSTEM IS DIFFERENT,IT IS BETTER TO COMPUTE THE ORBIT IN THEIR OWN SYSTEM,
	//BECAUSE TOE WILL BE DIFFERENT IF YOU TRANSFORM IT TO OTHER SYSTEM

	xnode = xnode - EARTH_ROTATE * eph->toe;
	xsat[0] = xx * cos(xnode) - yy * cos(xi) * sin(xnode);
	xsat[1] = xx * sin(xnode) + yy * cos(xi) * cos(xnode);
	xsat[2] = yy * sin(xi);

	for (i = 0; i < 3; i++)
		svpos[i] = xsat[i];

	if (strstr(cprn, "C01") != NULL || strstr(cprn, "C02") != NULL
			|| strstr(cprn, "C03") != NULL || strstr(cprn, "C04") != NULL
			|| strstr(cprn, "C05") != NULL) {
		// rx(-5.0*rad) for GEO
		pos[0] = xsat[0];
		pos[1] = cos(-5.0 * DEG2RAD) * xsat[1] + sin(-5.0 * DEG2RAD) * xsat[2];
		pos[2] = sin(5.0 * DEG2RAD) * xsat[1] + cos(-5.0 * DEG2RAD) * xsat[2];

		// rz(wearth*dt)
		xsat[0] = pos[0] * cos(EARTH_ROTATE * dt)
				+ pos[1] * sin(EARTH_ROTATE * dt);
		xsat[1] = -1.0 * pos[0] * sin(EARTH_ROTATE * dt)
				+ pos[1] * cos(EARTH_ROTATE * dt);
		xsat[2] = pos[2];
	}
	if (strstr(mode, "yyn") != NULL)
		return 1;

	asc = xnode;
	xinc = xi;
	xp = xx;
	yp = yy;

	edot = xn / (1 - e * cos(ex));
	cosf2 = cos(v / 2) * cos(v / 2);
	cose2 = cos(ex / 2) * cos(ex / 2);
	nudot = sqrt((1 + e) / (1 - e)) * cosf2 * edot / cose2;

	rdot =a * e * edot * sin(ex)
	+ 2 * (eph->crs * ccc - eph->crc * sss) * nudot;

	udot = (1 + 2.0 * eph->cus * ccc - 2.0 * eph->cuc * sss)
			* nudot;

	idot = eph->idot
			+ 2.0 * (eph->cic * ccc - eph->cis * sss) * nudot;

	if (strstr(cprn, "C01") != NULL || strstr(cprn, "C02") != NULL
			|| strstr(cprn, "C03") != NULL || strstr(cprn, "C04") != NULL
			|| strstr(cprn, "C05") != NULL) {
		asctrm = eph->omegadot;
	} else {
		asctrm = eph->omegadot - EARTH_ROTATE;
	}

	xpdot = rdot * cos(u) - r * sin(u) * udot;
	ypdot = rdot * sin(u) + r * cos(u) * udot;

	xsat[3] = xpdot * cos(asc) - ypdot * cos(xinc) * sin(asc)
			+ yp * sin(asc) * sin(xinc) * idot - xp * sin(asc) * asctrm
			- yp * cos(xinc) * cos(asc) * asctrm;
	xsat[4] = xpdot * sin(asc) + ypdot * cos(xinc) * cos(asc)
			- yp * cos(asc) * sin(xinc) * idot + xp * cos(asc) * asctrm
			- yp * cos(xinc) * sin(asc) * asctrm;
	xsat[5] = ypdot * sin(xinc) + yp * cos(xinc) * idot;

	if (strstr(cprn, "C01") != NULL || strstr(cprn, "C02") != NULL
			|| strstr(cprn, "C03") != NULL || strstr(cprn, "C04") != NULL
			|| strstr(cprn, "C05") != NULL) {
		// rx(-5.0*rad) for GEO
		geovel[0] = xsat[3];
		geovel[1] = cos(-5.0 * DEG2RAD) * xsat[4]
				+ sin(-5.0 * DEG2RAD) * xsat[5];
		geovel[2] = sin(5.0 * DEG2RAD) * xsat[4]
				+ cos(-5.0 * DEG2RAD) * xsat[5];

		// rz(wearth*dt)
		detavel[0] = geovel[0] * cos(EARTH_ROTATE * dt)
				+ geovel[1] * sin(EARTH_ROTATE * dt);
		detavel[1] = -1.0 * geovel[0] * sin(EARTH_ROTATE * dt)
				+ geovel[1] * cos(EARTH_ROTATE * dt);
		detavel[2] = geovel[2];

		// dot(R(w*t))*R(i)*XPOS
		geovel[0] = svpos[0];
		geovel[1] = cos(-5.0 * DEG2RAD) * svpos[1]
				+ sin(-5.0 * DEG2RAD) * svpos[2];
		geovel[2] = sin(5.0 * DEG2RAD) * svpos[1]
				+ cos(-5.0 * DEG2RAD) * svpos[2];

		// rz(wearth*dt)
		xsat[3] = EARTH_ROTATE
				* (-1.0 * geovel[0] * sin(EARTH_ROTATE * dt)
						+ geovel[1] * cos(EARTH_ROTATE * dt));
		xsat[4] = EARTH_ROTATE
				* (-1.0 * geovel[0] * cos(EARTH_ROTATE * dt)
						- geovel[1] * sin(EARTH_ROTATE * dt));
		xsat[5] = 0.0;

		// summary
		xsat[3] += detavel[0];
		xsat[4] += detavel[1];
		xsat[5] += detavel[2];
	}
	return 1;
}

// Assembly:
pushq %rbp
movq %rsp, %rbp
pushq %r15
pushq %r14
pushq %r13
pushq %r12
pushq %rbx
subq $0x128, %rsp            # imm = 0x128
movsd %xmm0, -0xa0(%rbp)
movl %ecx, %r15d
movq %rdx, %r14
movq %rdi, %r12
movb (%rdx), %al
addb $-0x43, %al
cmpb $0x7, %al
movq %r8, -0xf0(%rbp)
movq %rsi, -0x90(%rbp)
ja 0x5ac43
movzbl %al, %eax
shll $0x3, %eax
leaq 0x147a0(%rip), %rcx     # 0x6f3c0
movsd (%rax,%rcx), %xmm0
movsd %xmm0, -0xa8(%rbp)
leaq 0x147cc(%rip), %rcx     # 0x6f400
movsd (%rax,%rcx), %xmm0
movsd %xmm0, -0xc0(%rbp)
jmp 0x5ac63
movsd 0x146dd(%rip), %xmm0    # 0x6f328
movsd %xmm0, -0xc0(%rbp)
movsd 0x1005d(%rip), %xmm0    # 0x6acb8
movsd %xmm0, -0xa8(%rbp)
movq 0x20(%rbp), %r13
movq %r9, -0x40(%rbp)
andq $0x0, (%r9)
movabsq $0x4020000000000000, %rax # imm = 0x4020000000000000
movq 0x10(%rbp), %rcx
movq %rax, (%rcx)
movsbl (%r14), %esi
leaq 0x1470d(%rip), %rdi     # 0x6f398
callq 0x1a5f7
cltq
imulq $0x18, %rax, %rax
leaq (%r12,%rax), %rbx
addq $0x28, %rbx
movl %r15d, -0x70(%rbp)
cvtsi2sd %r15d, %xmm2
xorpd %xmm0, %xmm0
movsd %xmm0, -0x30(%rbp)
movb $0x1, %al
movl %eax, -0x38(%rbp)
movq %rbx, %r15
movsd %xmm2, -0x50(%rbp)
movq (%r15), %r15
cmpq %rbx, %r15
je 0x5ada0
leaq 0x10(%r15), %r12
movq %r12, %rdi
movq %r14, %rsi
callq 0x8170
movsd -0x50(%rbp), %xmm2
testq %rax, %rax
je 0x5acbd
movapd %xmm2, %xmm0
subsd 0xc8(%r15), %xmm0
movsd -0xa0(%rbp), %xmm1
subsd 0x78(%r15), %xmm1
divsd 0x5bab(%rip), %xmm1     # 0x608b0
mulsd 0x14623(%rip), %xmm0    # 0x6f330
addsd %xmm1, %xmm0
movl (%r13), %eax
testl %eax, %eax
js 0x5ad24
cmpl %eax, 0x38(%r15)
jne 0x5acbd
jmp 0x5adb2
cmpl $-0x2, %eax
je 0x5ad4a
cmpl $-0x1, %eax
jne 0x5acbd
andpd 0x4bfa(%rip), %xmm0     # 0x5f930
movq 0x10(%rbp), %rax
movsd (%rax), %xmm1
ucomisd %xmm0, %xmm1
jb 0x5acbd
jmp 0x5ad88
cvtsi2sdl 0x14(%r15), %xmm1
mulsd 0x5b68(%rip), %xmm1     # 0x608c0
addsd 0x18(%r15), %xmm1
ucomisd -0x30(%rbp), %xmm1
jbe 0x5acbd
andpd 0x4bbf(%rip), %xmm0     # 0x5f930
movsd 0x7037(%rip), %xmm3     # 0x61db0
ucomisd %xmm0, %xmm3
jb 0x5acbd
movsd %xmm1, -0x30(%rbp)
movq 0x10(%rbp), %rax
movsd %xmm0, (%rax)
movl $0x0, -0x38(%rbp)
movq %r12, -0x48(%rbp)
jmp 0x5acbd
xorl %r15d, %r15d
testb $0x1, -0x38(%rbp)
movq -0x48(%rbp), %r12
je 0x5adc2
jmp 0x5bb06
andpd 0x4b76(%rip), %xmm0     # 0x5f930
movq 0x10(%rbp), %rax
movlpd %xmm0, (%rax)
movl 0x28(%r12), %eax
movl %eax, (%r13)
subsd 0xb8(%r12), %xmm2
mulsd 0x6ffb(%rip), %xmm2     # 0x61dd8
movsd -0xa0(%rbp), %xmm1
addsd %xmm1, %xmm2
subsd 0x68(%r12), %xmm2
movsd %xmm2, -0x50(%rbp)
imull $0x7, -0x70(%rbp), %eax
subl 0x4(%r12), %eax
addl $0xacd4, %eax           # imm = 0xACD4
cvtsi2sd %eax, %xmm0
mulsd 0x5ab1(%rip), %xmm0     # 0x608c0
addsd %xmm1, %xmm0
subsd 0x8(%r12), %xmm0
movsd 0x20(%r12), %xmm1
mulsd %xmm0, %xmm1
addsd 0x18(%r12), %xmm1
mulsd %xmm0, %xmm1
addsd 0x10(%r12), %xmm1
movq -0x40(%rbp), %rax
movsd %xmm1, (%rax)
movsd 0xd8(%r12), %xmm0
movq 0x18(%rbp), %rax
movsd %xmm0, (%rax)
leaq 0x145e8(%rip), %rsi     # 0x6f440
movq -0x90(%rbp), %r13
movq %r13, %rdi
callq 0x8170
pushq $0x1
popq %r15
testq %rax, %rax
jne 0x5bb06
movsd 0x50(%r12), %xmm0
movaps %xmm0, -0xa0(%rbp)
movsd 0x60(%r12), %xmm0
mulsd %xmm0, %xmm0
movsd -0xc0(%rbp), %xmm1
divsd %xmm0, %xmm1
divsd %xmm0, %xmm1
movsd %xmm0, -0xb0(%rbp)
divsd %xmm0, %xmm1
sqrtsd %xmm1, %xmm0
addsd 0x38(%r12), %xmm0
movsd %xmm0, -0xd8(%rbp)
mulsd -0x50(%rbp), %xmm0
addsd 0x40(%r12), %xmm0
pushq $0xc
popq %rbx
movsd %xmm0, -0x30(%rbp)
subl $0x1, %ebx
jb 0x5aee9
callq 0x8160
mulsd -0xa0(%rbp), %xmm0
addsd -0x30(%rbp), %xmm0
jmp 0x5aed0
movsd %xmm0, -0x70(%rbp)
callq 0x8bf0
movapd 0x5bc5(%rip), %xmm2     # 0x60ac0
movapd -0xa0(%rbp), %xmm1
xorpd %xmm1, %xmm2
movapd %xmm2, -0x130(%rbp)
mulsd %xmm1, %xmm0
movsd 0x4a05(%rip), %xmm2     # 0x5f920
movapd %xmm2, %xmm3
subsd %xmm0, %xmm3
movsd %xmm3, -0x30(%rbp)
mulsd %xmm1, %xmm1
movapd %xmm2, %xmm0
subsd %xmm1, %xmm0
xorpd %xmm1, %xmm1
ucomisd %xmm1, %xmm0
jb 0x5af44
sqrtsd %xmm0, %xmm0
jmp 0x5af49
callq 0x84e0
movsd %xmm0, -0x38(%rbp)
movq -0xf0(%rbp), %rbx
movsd -0x70(%rbp), %xmm0
callq 0x8160
mulsd -0x38(%rbp), %xmm0
divsd -0x30(%rbp), %xmm0
movsd %xmm0, -0x38(%rbp)
movsd -0x70(%rbp), %xmm0
callq 0x8bf0
subsd -0xa0(%rbp), %xmm0
divsd -0x30(%rbp), %xmm0
movsd %xmm0, -0x30(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8a80
andpd 0x4994(%rip), %xmm0     # 0x5f930
movsd -0x30(%rbp), %xmm1
ucomisd 0x594f(%rip), %xmm1     # 0x608f8
jae 0x5afc0
xorpd %xmm1, %xmm1
ucomisd -0x38(%rbp), %xmm1
jae 0x5afdd
movsd 0x5942(%rip), %xmm1     # 0x60900
jmp 0x5afd3
xorpd %xmm1, %xmm1
ucomisd -0x38(%rbp), %xmm1
jbe 0x5afe5
movsd 0x5935(%rip), %xmm1     # 0x60908
subsd %xmm0, %xmm1
movapd %xmm1, %xmm0
jmp 0x5afe5
addsd 0x591b(%rip), %xmm0     # 0x60900
movsd 0x98(%r12), %xmm1
movapd %xmm0, -0x100(%rbp)
addsd %xmm0, %xmm1
movsd %xmm1, -0x30(%rbp)
movapd %xmm1, %xmm0
addsd %xmm1, %xmm0
movsd %xmm0, -0x38(%rbp)
callq 0x8bf0
movsd %xmm0, -0xe0(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8160
movsd 0x58(%r12), %xmm1
mulsd %xmm0, %xmm1
movsd 0x48(%r12), %xmm2
movsd -0xe0(%rbp), %xmm3
mulsd %xmm3, %xmm2
addsd %xmm1, %xmm2
movsd %xmm2, -0x40(%rbp)
movsd 0x30(%r12), %xmm1
mulsd %xmm0, %xmm1
movsd 0x90(%r12), %xmm2
mulsd %xmm3, %xmm2
addsd %xmm1, %xmm2
movsd %xmm2, -0xc0(%rbp)
movsd 0x80(%r12), %xmm1
movsd %xmm0, -0x118(%rbp)
mulsd %xmm0, %xmm1
movsd 0x70(%r12), %xmm0
mulsd %xmm3, %xmm0
addsd %xmm1, %xmm0
movsd %xmm0, -0x38(%rbp)
movsd -0x70(%rbp), %xmm0
callq 0x8bf0
mulsd -0x130(%rbp), %xmm0
addsd 0x486c(%rip), %xmm0     # 0x5f920
mulsd -0xb0(%rbp), %xmm0
addsd -0xc0(%rbp), %xmm0
movsd %xmm0, -0x58(%rbp)
movsd -0x40(%rbp), %xmm0
addsd -0x30(%rbp), %xmm0
movsd %xmm0, -0x40(%rbp)
movsd 0xa8(%r12), %xmm1
mulsd -0x50(%rbp), %xmm1
addsd 0x88(%r12), %xmm1
addsd -0x38(%rbp), %xmm1
movsd %xmm1, -0x38(%rbp)
callq 0x8bf0
mulsd -0x58(%rbp), %xmm0
movsd %xmm0, -0xc8(%rbp)
movsd -0x40(%rbp), %xmm0
callq 0x8160
mulsd -0x58(%rbp), %xmm0
movapd %xmm0, -0xc0(%rbp)
leaq 0x14319(%rip), %rsi     # 0x6f444
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b18c
leaq 0x14309(%rip), %rsi     # 0x6f448
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b18c
leaq 0x142f9(%rip), %rsi     # 0x6f44c
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b18c
leaq 0x142e9(%rip), %rsi     # 0x6f450
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b18c
leaq 0x142d9(%rip), %rsi     # 0x6f454
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
je 0x5bb1b
movsd 0xa0(%r12), %xmm0
mulsd -0x50(%rbp), %xmm0
addsd 0x78(%r12), %xmm0
movsd 0x68(%r12), %xmm1
mulsd -0xa8(%rbp), %xmm1
subsd %xmm1, %xmm0
movsd %xmm0, -0x30(%rbp)
callq 0x8bf0
movsd %xmm0, -0x48(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8bf0
movsd %xmm0, -0x78(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8160
movapd 0x58db(%rip), %xmm1     # 0x60ac0
movapd -0xc0(%rbp), %xmm2
xorpd %xmm2, %xmm1
movapd %xmm1, -0x110(%rbp)
movsd -0x78(%rbp), %xmm1
mulsd %xmm2, %xmm1
mulsd %xmm0, %xmm1
movsd -0x48(%rbp), %xmm0
mulsd -0xc8(%rbp), %xmm0
subsd %xmm1, %xmm0
movsd %xmm0, (%rbx)
movsd -0x30(%rbp), %xmm0
callq 0x8160
movsd %xmm0, -0x48(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8bf0
mulsd -0xc0(%rbp), %xmm0
movsd %xmm0, -0x78(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8bf0
mulsd -0x78(%rbp), %xmm0
movsd -0x48(%rbp), %xmm1
mulsd -0xc8(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, 0x8(%rbx)
movsd -0x38(%rbp), %xmm0
callq 0x8160
mulsd -0xc0(%rbp), %xmm0
movsd %xmm0, -0x48(%rbp)
movsd %xmm0, 0x10(%rbx)
xorl %eax, %eax
cmpq $0x3, %rax
je 0x5b29d
movsd (%rbx,%rax,8), %xmm0
movsd %xmm0, -0x150(%rbp,%rax,8)
incq %rax
jmp 0x5b284
leaq 0x141a0(%rip), %rsi     # 0x6f444
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b305
leaq 0x14190(%rip), %rsi     # 0x6f448
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b305
leaq 0x14180(%rip), %rsi     # 0x6f44c
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b305
leaq 0x14170(%rip), %rsi     # 0x6f450
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b305
leaq 0x14160(%rip), %rsi     # 0x6f454
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
je 0x5b3e5
movsd (%rbx), %xmm0
movsd %xmm0, -0x78(%rbp)
movsd 0x8(%rbx), %xmm3
movsd 0x1401d(%rip), %xmm0    # 0x6f338
movsd -0x48(%rbp), %xmm2
mulsd %xmm2, %xmm0
movsd 0x14014(%rip), %xmm1    # 0x6f340
movapd %xmm3, %xmm4
mulsd %xmm1, %xmm4
addsd %xmm0, %xmm4
movsd %xmm4, -0xe8(%rbp)
mulsd 0x14000(%rip), %xmm3    # 0x6f348
mulsd %xmm1, %xmm2
addsd %xmm2, %xmm3
movsd %xmm3, -0x120(%rbp)
movsd -0xa8(%rbp), %xmm0
mulsd -0x50(%rbp), %xmm0
movsd %xmm0, -0x48(%rbp)
callq 0x8bf0
movsd %xmm0, -0xd0(%rbp)
movsd -0x48(%rbp), %xmm0
callq 0x8160
mulsd -0xe8(%rbp), %xmm0
movsd -0xd0(%rbp), %xmm1
mulsd -0x78(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, (%rbx)
movsd -0x48(%rbp), %xmm0
callq 0x8160
movsd %xmm0, -0xd0(%rbp)
movsd -0x48(%rbp), %xmm0
callq 0x8bf0
mulsd -0xe8(%rbp), %xmm0
movsd -0xd0(%rbp), %xmm1
mulsd -0x78(%rbp), %xmm1
subsd %xmm1, %xmm0
movsd %xmm0, 0x8(%rbx)
movsd -0x120(%rbp), %xmm0
movsd %xmm0, 0x10(%rbx)
leaq 0x1406c(%rip), %rsi     # 0x6f458
movq %r13, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5bb06
movsd -0x70(%rbp), %xmm0
callq 0x8bf0
movapd -0x130(%rbp), %xmm1
mulsd %xmm0, %xmm1
movsd 0x4505(%rip), %xmm0     # 0x5f920
addsd %xmm0, %xmm1
movsd -0xd8(%rbp), %xmm0
divsd %xmm1, %xmm0
movsd %xmm0, -0xd8(%rbp)
movapd -0x100(%rbp), %xmm0
mulsd 0x6835(%rip), %xmm0     # 0x61c78
movapd %xmm0, -0x100(%rbp)
callq 0x8bf0
movsd %xmm0, -0x90(%rbp)
movapd -0x100(%rbp), %xmm0
callq 0x8bf0
mulsd -0x90(%rbp), %xmm0
movsd %xmm0, -0x90(%rbp)
movsd 0x67fb(%rip), %xmm0     # 0x61c78
mulsd -0x70(%rbp), %xmm0
movsd %xmm0, -0x78(%rbp)
callq 0x8bf0
movsd %xmm0, -0x48(%rbp)
movsd -0x78(%rbp), %xmm0
callq 0x8bf0
movapd %xmm0, %xmm3
mulsd -0x48(%rbp), %xmm3
movapd -0xa0(%rbp), %xmm1
movapd %xmm1, %xmm0
movsd 0x4468(%rip), %xmm2     # 0x5f920
addsd %xmm2, %xmm0
subsd %xmm1, %xmm2
divsd %xmm2, %xmm0
xorpd %xmm1, %xmm1
ucomisd %xmm1, %xmm0
jb 0x5b4d4
sqrtsd %xmm0, %xmm0
jmp 0x5b4e3
movsd %xmm3, -0x48(%rbp)
callq 0x84e0
movsd -0x48(%rbp), %xmm3
movsd -0x90(%rbp), %xmm1
mulsd %xmm0, %xmm1
movsd -0xd8(%rbp), %xmm0
mulsd %xmm0, %xmm1
divsd %xmm3, %xmm1
movsd %xmm1, -0x90(%rbp)
movsd -0xb0(%rbp), %xmm1
mulsd -0xa0(%rbp), %xmm1
mulsd %xmm0, %xmm1
movsd %xmm1, -0xb0(%rbp)
movsd -0x70(%rbp), %xmm0
callq 0x8160
movsd 0x90(%r12), %xmm4
movsd -0x118(%rbp), %xmm3
mulsd %xmm3, %xmm4
movsd 0x30(%r12), %xmm1
movsd -0xe0(%rbp), %xmm2
mulsd %xmm2, %xmm1
subsd %xmm4, %xmm1
addsd %xmm1, %xmm1
movsd -0x90(%rbp), %xmm4
mulsd %xmm4, %xmm1
mulsd -0xb0(%rbp), %xmm0
addsd %xmm1, %xmm0
movsd %xmm0, -0xb0(%rbp)
movsd 0x48(%r12), %xmm1
movsd 0x58(%r12), %xmm0
addsd %xmm0, %xmm0
mulsd %xmm2, %xmm0
addsd 0x4384(%rip), %xmm0     # 0x5f920
mulsd 0x6854(%rip), %xmm1     # 0x61df8
mulsd %xmm3, %xmm1
addsd %xmm0, %xmm1
mulsd %xmm4, %xmm1
movsd %xmm1, -0x78(%rbp)
movsd 0x80(%r12), %xmm0
mulsd %xmm3, %xmm0
movsd 0x70(%r12), %xmm1
mulsd %xmm2, %xmm1
subsd %xmm0, %xmm1
addsd %xmm1, %xmm1
mulsd %xmm4, %xmm1
addsd 0xa8(%r12), %xmm1
movsd %xmm1, -0x48(%rbp)
leaq 0x13e54(%rip), %rsi     # 0x6f444
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b651
leaq 0x13e44(%rip), %rsi     # 0x6f448
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b651
leaq 0x13e34(%rip), %rsi     # 0x6f44c
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b651
leaq 0x13e24(%rip), %rsi     # 0x6f450
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b651
leaq 0x13e14(%rip), %rsi     # 0x6f454
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
je 0x5bb32
movsd 0xa0(%r12), %xmm0
movsd %xmm0, -0x90(%rbp)
movsd -0x40(%rbp), %xmm0
callq 0x8bf0
movsd %xmm0, -0x70(%rbp)
movsd -0x40(%rbp), %xmm0
callq 0x8160
mulsd -0x58(%rbp), %xmm0
mulsd -0x78(%rbp), %xmm0
movsd -0x70(%rbp), %xmm1
mulsd -0xb0(%rbp), %xmm1
subsd %xmm0, %xmm1
movsd %xmm1, -0x70(%rbp)
movsd -0x40(%rbp), %xmm0
callq 0x8160
movsd %xmm0, -0xa0(%rbp)
movsd -0x40(%rbp), %xmm0
callq 0x8bf0
mulsd -0x58(%rbp), %xmm0
mulsd -0x78(%rbp), %xmm0
movsd -0xa0(%rbp), %xmm1
mulsd -0xb0(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, -0xa0(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8bf0
movsd %xmm0, -0x40(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8bf0
movsd %xmm0, -0x58(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8160
movsd -0x58(%rbp), %xmm1
mulsd -0xa0(%rbp), %xmm1
mulsd %xmm0, %xmm1
movsd -0x40(%rbp), %xmm0
mulsd -0x70(%rbp), %xmm0
subsd %xmm1, %xmm0
movsd %xmm0, -0x40(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8160
mulsd -0xc0(%rbp), %xmm0
movsd %xmm0, -0x58(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8160
mulsd -0x58(%rbp), %xmm0
mulsd -0x48(%rbp), %xmm0
addsd -0x40(%rbp), %xmm0
movsd %xmm0, -0x40(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8160
mulsd -0xc8(%rbp), %xmm0
mulsd -0x90(%rbp), %xmm0
movsd -0x40(%rbp), %xmm1
subsd %xmm0, %xmm1
movsd %xmm1, -0x40(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8bf0
movsd %xmm0, -0x58(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8bf0
movsd -0x58(%rbp), %xmm1
mulsd -0x110(%rbp), %xmm1
mulsd %xmm0, %xmm1
mulsd -0x90(%rbp), %xmm1
addsd -0x40(%rbp), %xmm1
movsd %xmm1, 0x18(%rbx)
movsd -0x30(%rbp), %xmm0
callq 0x8160
movsd %xmm0, -0x40(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8bf0
mulsd -0xa0(%rbp), %xmm0
movsd %xmm0, -0x58(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8bf0
mulsd -0x58(%rbp), %xmm0
movsd -0x40(%rbp), %xmm1
mulsd -0x70(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, -0x40(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8bf0
movsd %xmm0, -0x70(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8160
movsd -0x70(%rbp), %xmm1
mulsd -0x110(%rbp), %xmm1
mulsd %xmm0, %xmm1
mulsd -0x48(%rbp), %xmm1
addsd -0x40(%rbp), %xmm1
movsd %xmm1, -0x70(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8bf0
mulsd -0xc8(%rbp), %xmm0
mulsd -0x90(%rbp), %xmm0
addsd -0x70(%rbp), %xmm0
movsd %xmm0, -0x40(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8bf0
movsd %xmm0, -0x70(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8160
movsd -0x70(%rbp), %xmm1
mulsd -0x110(%rbp), %xmm1
mulsd %xmm0, %xmm1
mulsd -0x90(%rbp), %xmm1
addsd -0x40(%rbp), %xmm1
movsd %xmm1, 0x20(%rbx)
movsd -0x38(%rbp), %xmm0
callq 0x8160
movsd %xmm0, -0x30(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8bf0
mulsd -0xc0(%rbp), %xmm0
mulsd -0x48(%rbp), %xmm0
movsd -0x30(%rbp), %xmm1
mulsd -0xa0(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, -0x30(%rbp)
movsd %xmm1, 0x28(%rbx)
leaq 0x13b58(%rip), %rsi     # 0x6f444
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b94d
leaq 0x13b48(%rip), %rsi     # 0x6f448
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b94d
leaq 0x13b38(%rip), %rsi     # 0x6f44c
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b94d
leaq 0x13b28(%rip), %rsi     # 0x6f450
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
jne 0x5b94d
leaq 0x13b18(%rip), %rsi     # 0x6f454
movq %r14, %rdi
callq 0x8170
testq %rax, %rax
je 0x5bb06
movsd 0x18(%rbx), %xmm0
movsd %xmm0, -0x38(%rbp)
movsd 0x20(%rbx), %xmm1
movsd -0x30(%rbp), %xmm2
movapd %xmm2, %xmm0
mulsd 0x139cb(%rip), %xmm0    # 0x6f338
movsd 0x139cb(%rip), %xmm3    # 0x6f340
movapd %xmm1, %xmm4
mulsd %xmm3, %xmm4
addsd %xmm0, %xmm4
movsd %xmm4, -0x90(%rbp)
mulsd %xmm3, %xmm2
mulsd 0x139b3(%rip), %xmm1    # 0x6f348
addsd %xmm2, %xmm1
movsd %xmm1, -0x40(%rbp)
movsd -0x50(%rbp), %xmm0
mulsd -0xa8(%rbp), %xmm0
movsd %xmm0, -0x50(%rbp)
callq 0x8bf0
movsd %xmm0, -0xa0(%rbp)
movsd -0x50(%rbp), %xmm0
callq 0x8160
mulsd -0x90(%rbp), %xmm0
movsd -0xa0(%rbp), %xmm1
mulsd -0x38(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, -0xa0(%rbp)
movsd -0x50(%rbp), %xmm0
callq 0x8160
movsd %xmm0, -0x30(%rbp)
movsd -0x50(%rbp), %xmm0
callq 0x8bf0
mulsd -0x90(%rbp), %xmm0
movsd -0x30(%rbp), %xmm1
mulsd -0x38(%rbp), %xmm1
subsd %xmm1, %xmm0
movsd %xmm0, -0x38(%rbp)
movsd 0x13914(%rip), %xmm1    # 0x6f338
mulsd -0x140(%rbp), %xmm1
movsd 0x1390c(%rip), %xmm0    # 0x6f340
mulsd -0x148(%rbp), %xmm0
movsd -0x150(%rbp), %xmm2
movapd %xmm2, -0x70(%rbp)
addsd %xmm1, %xmm0
movsd %xmm0, -0x30(%rbp)
movapd 0x5066(%rip), %xmm0     # 0x60ac0
xorpd %xmm2, %xmm0
movapd %xmm0, -0x90(%rbp)
movsd -0x50(%rbp), %xmm0
callq 0x8160
movsd %xmm0, -0xc0(%rbp)
movsd -0x50(%rbp), %xmm0
callq 0x8bf0
mulsd -0x30(%rbp), %xmm0
movsd -0xc0(%rbp), %xmm1
mulsd -0x70(%rbp), %xmm1
subsd %xmm1, %xmm0
mulsd -0xa8(%rbp), %xmm0
movsd %xmm0, 0x18(%rbx)
movsd -0x50(%rbp), %xmm0
callq 0x8bf0
movsd %xmm0, -0x70(%rbp)
movsd -0x50(%rbp), %xmm0
callq 0x8160
mulsd -0x30(%rbp), %xmm0
movsd -0x70(%rbp), %xmm1
mulsd -0x90(%rbp), %xmm1
subsd %xmm0, %xmm1
mulsd -0xa8(%rbp), %xmm1
addsd -0x38(%rbp), %xmm1
movsd -0xa0(%rbp), %xmm0
addsd 0x18(%rbx), %xmm0
movsd %xmm0, 0x18(%rbx)
movsd %xmm1, 0x20(%rbx)
xorpd %xmm0, %xmm0
addsd -0x40(%rbp), %xmm0
movsd %xmm0, 0x28(%rbx)
movl %r15d, %eax
addq $0x128, %rsp            # imm = 0x128
popq %rbx
popq %r12
popq %r13
popq %r14
popq %r15
popq %rbp
retq
movsd 0xa0(%r12), %xmm0
subsd -0xa8(%rbp), %xmm0
jmp 0x5b196
movsd 0xa0(%r12), %xmm0
subsd -0xa8(%rbp), %xmm0
jmp 0x5b65b
nop