// File: /workspace/github_cpp_makefile_star2_O1/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, -0x90(%rbp)
movq %rcx, -0x38(%rbp)
movq %rdx, %r14
movq %rdi, %r12
movb (%rdx), %al
addb $-0x43, %al
cmpb $0x7, %al
movq %r8, -0x108(%rbp)
movq %rsi, -0x70(%rbp)
ja 0x65331
movzbl %al, %eax
shll $0x3, %eax
leaq 0x140ea(%rip), %rcx     # 0x793f8
movsd (%rax,%rcx), %xmm0
movsd %xmm0, -0xa0(%rbp)
leaq 0x14116(%rip), %rcx     # 0x79438
movsd (%rax,%rcx), %xmm0
movsd %xmm0, -0xd0(%rbp)
jmp 0x65351
movsd 0x14027(%rip), %xmm0    # 0x79360
movsd %xmm0, -0xd0(%rbp)
movsd 0xf98f(%rip), %xmm0     # 0x74cd8
movsd %xmm0, -0xa0(%rbp)
movq 0x20(%rbp), %rbx
movq %r9, -0x40(%rbp)
movq $0x0, (%r9)
movabsq $0x4020000000000000, %rax # imm = 0x4020000000000000
movq 0x10(%rbp), %rcx
movq %rax, (%rcx)
movsbl (%r14), %esi
leaq 0x14054(%rip), %rdi     # 0x793d0
callq 0x1db90
cltq
leaq (%rax,%rax,2), %rax
leaq (%r12,%rax,8), %r13
addq $0x28, %r13
movq (%r13), %r15
xorps %xmm0, %xmm0
cvtsi2sdl -0x38(%rbp), %xmm0
cmpq %r13, %r15
je 0x654a2
movsd %xmm0, -0x48(%rbp)
movl $0x0, -0x60(%rbp)
xorpd %xmm0, %xmm0
movsd %xmm0, -0x30(%rbp)
leaq 0x10(%r15), %r12
movq %r12, %rdi
movq %r14, %rsi
callq 0x8160
testq %rax, %rax
je 0x6540d
movsd -0x48(%rbp), %xmm0
subsd 0xc8(%r15), %xmm0
movsd -0x90(%rbp), %xmm1
subsd 0x78(%r15), %xmm1
divsd 0x54cf(%rip), %xmm1     # 0x6a8c0
mulsd 0x13f6f(%rip), %xmm0    # 0x79368
addsd %xmm1, %xmm0
movl (%rbx), %eax
testl %eax, %eax
js 0x65417
cmpl %eax, 0x38(%r15)
je 0x654a6
movq (%r15), %r15
cmpq %r13, %r15
jne 0x653b9
jmp 0x65492
cmpl $-0x2, %eax
je 0x6543e
cmpl $-0x1, %eax
jne 0x6540d
andpd 0x4507(%rip), %xmm0     # 0x69930
movq 0x10(%rbp), %rax
movsd (%rax), %xmm1
ucomisd %xmm0, %xmm1
jb 0x6540d
movsd -0x30(%rbp), %xmm1
jmp 0x65472
xorps %xmm1, %xmm1
cvtsi2sdl 0x14(%r15), %xmm1
mulsd 0x5481(%rip), %xmm1     # 0x6a8d0
addsd 0x18(%r15), %xmm1
ucomisd -0x30(%rbp), %xmm1
jbe 0x6540d
andpd 0x44cc(%rip), %xmm0     # 0x69930
movsd 0x6944(%rip), %xmm2     # 0x6bdb0
ucomisd %xmm0, %xmm2
jb 0x6540d
movq 0x10(%rbp), %rax
movsd %xmm0, (%rax)
movl $0x1, -0x60(%rbp)
movq %r12, -0xb0(%rbp)
movsd %xmm1, -0x30(%rbp)
jmp 0x6540d
cmpl $0x0, -0x60(%rbp)
sete %al
movq -0xb0(%rbp), %r12
jmp 0x654b8
movb $0x1, %al
jmp 0x654bd
andpd 0x4482(%rip), %xmm0     # 0x69930
movq 0x10(%rbp), %rax
movlpd %xmm0, (%rax)
xorl %eax, %eax
movsd -0x48(%rbp), %xmm0
xorl %r15d, %r15d
testb %al, %al
jne 0x6623f
movl 0x28(%r12), %eax
movl %eax, (%rbx)
subsd 0xb8(%r12), %xmm0
mulsd 0x6907(%rip), %xmm0     # 0x6bde8
movsd -0x90(%rbp), %xmm1
addsd %xmm1, %xmm0
subsd 0x68(%r12), %xmm0
movsd %xmm0, -0x48(%rbp)
movq -0x38(%rbp), %rcx
leal (,%rcx,8), %eax
subl %ecx, %eax
subl 0x4(%r12), %eax
addl $0xacd4, %eax           # imm = 0xACD4
xorps %xmm0, %xmm0
cvtsi2sd %eax, %xmm0
mulsd 0x53b1(%rip), %xmm0     # 0x6a8d0
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 0x18(%rbp), %rax
movq -0x40(%rbp), %rcx
movsd %xmm1, (%rcx)
movsd 0xd8(%r12), %xmm0
movsd %xmm0, (%rax)
leaq 0x13f10(%rip), %rsi     # 0x79478
movq -0x70(%rbp), %r13
movq %r13, %rdi
callq 0x8160
movl $0x1, %r15d
testq %rax, %rax
jne 0x6623f
movsd 0x60(%r12), %xmm1
mulsd %xmm1, %xmm1
movsd -0xd0(%rbp), %xmm0
divsd %xmm1, %xmm0
divsd %xmm1, %xmm0
movsd %xmm1, -0x98(%rbp)
divsd %xmm1, %xmm0
xorpd %xmm1, %xmm1
ucomisd %xmm1, %xmm0
jb 0x655ba
sqrtsd %xmm0, %xmm0
jmp 0x655bf
callq 0x84e0
movsd -0x48(%rbp), %xmm1
addsd 0x38(%r12), %xmm0
movsd %xmm0, -0xf0(%rbp)
movapd %xmm0, %xmm2
mulsd %xmm1, %xmm2
addsd 0x40(%r12), %xmm2
movsd 0x50(%r12), %xmm0
movaps %xmm0, -0x90(%rbp)
movl $0xc, %ebx
movsd %xmm2, -0x30(%rbp)
movapd %xmm2, %xmm0
callq 0x8150
mulsd -0x90(%rbp), %xmm0
addsd -0x30(%rbp), %xmm0
decl %ebx
jne 0x655fe
movsd %xmm0, -0x40(%rbp)
callq 0x8c00
movapd 0x54aa(%rip), %xmm1     # 0x6aad0
movapd -0x90(%rbp), %xmm3
xorpd %xmm3, %xmm1
movapd %xmm1, -0x150(%rbp)
mulsd %xmm3, %xmm0
movsd 0x42da(%rip), %xmm2     # 0x69920
movapd %xmm2, %xmm1
subsd %xmm0, %xmm1
movsd %xmm1, -0x30(%rbp)
movapd %xmm3, %xmm1
mulsd %xmm3, %xmm1
movapd %xmm2, %xmm0
subsd %xmm1, %xmm0
xorpd %xmm1, %xmm1
ucomisd %xmm1, %xmm0
jb 0x65673
sqrtsd %xmm0, %xmm0
jmp 0x65678
callq 0x84e0
movsd %xmm0, -0x38(%rbp)
movq -0x108(%rbp), %rbx
movsd -0x40(%rbp), %xmm0
callq 0x8150
mulsd -0x38(%rbp), %xmm0
divsd -0x30(%rbp), %xmm0
movsd %xmm0, -0x38(%rbp)
movsd -0x40(%rbp), %xmm0
callq 0x8c00
subsd -0x90(%rbp), %xmm0
divsd -0x30(%rbp), %xmm0
movsd %xmm0, -0x30(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8a90
andpd 0x4265(%rip), %xmm0     # 0x69930
movsd -0x30(%rbp), %xmm1
ucomisd 0x5230(%rip), %xmm1     # 0x6a908
jae 0x656ef
xorpd %xmm1, %xmm1
ucomisd -0x38(%rbp), %xmm1
jae 0x6570c
movsd 0x5223(%rip), %xmm1     # 0x6a910
jmp 0x65702
xorpd %xmm1, %xmm1
ucomisd -0x38(%rbp), %xmm1
jbe 0x65714
movsd 0x5216(%rip), %xmm1     # 0x6a918
subsd %xmm0, %xmm1
movapd %xmm1, %xmm0
jmp 0x65714
addsd 0x51fc(%rip), %xmm0     # 0x6a910
movsd 0x98(%r12), %xmm1
movapd %xmm0, -0x120(%rbp)
addsd %xmm0, %xmm1
movsd %xmm1, -0x30(%rbp)
movapd %xmm1, %xmm0
addsd %xmm1, %xmm0
movsd %xmm0, -0x38(%rbp)
callq 0x8c00
movsd %xmm0, -0x100(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8150
movsd 0x58(%r12), %xmm1
mulsd %xmm0, %xmm1
movsd 0x48(%r12), %xmm2
movsd -0x100(%rbp), %xmm3
mulsd %xmm3, %xmm2
addsd %xmm1, %xmm2
movsd %xmm2, -0x60(%rbp)
movsd 0x30(%r12), %xmm1
mulsd %xmm0, %xmm1
movsd 0x90(%r12), %xmm2
mulsd %xmm3, %xmm2
addsd %xmm1, %xmm2
movsd %xmm2, -0xb0(%rbp)
movsd 0x80(%r12), %xmm1
movsd %xmm0, -0x128(%rbp)
mulsd %xmm0, %xmm1
movsd 0x70(%r12), %xmm0
mulsd %xmm3, %xmm0
addsd %xmm1, %xmm0
movsd %xmm0, -0x38(%rbp)
movsd -0x40(%rbp), %xmm0
callq 0x8c00
mulsd -0x150(%rbp), %xmm0
addsd 0x413d(%rip), %xmm0     # 0x69920
mulsd -0x98(%rbp), %xmm0
addsd -0xb0(%rbp), %xmm0
movsd %xmm0, -0x78(%rbp)
movsd -0x60(%rbp), %xmm0
addsd -0x30(%rbp), %xmm0
movsd %xmm0, -0x60(%rbp)
movsd 0xa8(%r12), %xmm1
mulsd -0x48(%rbp), %xmm1
addsd 0x88(%r12), %xmm1
addsd -0x38(%rbp), %xmm1
movsd %xmm1, -0x38(%rbp)
callq 0x8c00
mulsd -0x78(%rbp), %xmm0
movsd %xmm0, -0xe0(%rbp)
movsd -0x60(%rbp), %xmm0
callq 0x8150
mulsd -0x78(%rbp), %xmm0
movapd %xmm0, -0xb0(%rbp)
leaq 0x13c22(%rip), %rsi     # 0x7947c
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x658bb
leaq 0x13c12(%rip), %rsi     # 0x79480
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x658bb
leaq 0x13c02(%rip), %rsi     # 0x79484
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x658bb
leaq 0x13bf2(%rip), %rsi     # 0x79488
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x658bb
leaq 0x13be2(%rip), %rsi     # 0x7948c
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
je 0x66254
movsd 0xa0(%r12), %xmm0
mulsd -0x48(%rbp), %xmm0
addsd 0x78(%r12), %xmm0
movsd 0x68(%r12), %xmm1
mulsd -0xa0(%rbp), %xmm1
subsd %xmm1, %xmm0
movsd %xmm0, -0x30(%rbp)
callq 0x8c00
movsd %xmm0, -0xd0(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8c00
movsd %xmm0, -0x68(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8150
movsd -0x68(%rbp), %xmm1
mulsd -0xb0(%rbp), %xmm1
mulsd %xmm0, %xmm1
movsd -0xd0(%rbp), %xmm0
mulsd -0xe0(%rbp), %xmm0
subsd %xmm1, %xmm0
movsd %xmm0, (%rbx)
movsd -0x30(%rbp), %xmm0
callq 0x8150
movsd %xmm0, -0xd0(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8c00
mulsd -0xb0(%rbp), %xmm0
movsd %xmm0, -0x68(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8c00
mulsd -0x68(%rbp), %xmm0
movsd -0xd0(%rbp), %xmm1
mulsd -0xe0(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, 0x8(%rbx)
movsd -0x38(%rbp), %xmm0
callq 0x8150
mulsd -0xb0(%rbp), %xmm0
movsd %xmm0, -0xf8(%rbp)
movsd %xmm0, 0x10(%rbx)
movsd (%rbx), %xmm0
movaps %xmm0, -0x140(%rbp)
movsd 0x8(%rbx), %xmm0
movsd %xmm0, -0xd8(%rbp)
leaq 0x13ab5(%rip), %rsi     # 0x7947c
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x65a28
leaq 0x13aa5(%rip), %rsi     # 0x79480
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x65a28
leaq 0x13a95(%rip), %rsi     # 0x79484
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x65a28
leaq 0x13a85(%rip), %rsi     # 0x79488
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x65a28
leaq 0x13a75(%rip), %rsi     # 0x7948c
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
je 0x65b17
movsd (%rbx), %xmm0
movsd %xmm0, -0x68(%rbp)
movsd 0x8(%rbx), %xmm3
movsd 0x13932(%rip), %xmm0    # 0x79370
movsd -0xf8(%rbp), %xmm2
mulsd %xmm2, %xmm0
movsd 0x13926(%rip), %xmm1    # 0x79378
movapd %xmm3, %xmm4
mulsd %xmm1, %xmm4
addsd %xmm0, %xmm4
movsd %xmm4, -0xb8(%rbp)
mulsd 0x13912(%rip), %xmm3    # 0x79380
mulsd %xmm2, %xmm1
addsd %xmm1, %xmm3
movsd %xmm3, -0x130(%rbp)
movsd -0xa0(%rbp), %xmm0
mulsd -0x48(%rbp), %xmm0
movsd %xmm0, -0xd0(%rbp)
callq 0x8c00
movsd %xmm0, -0xe8(%rbp)
movsd -0xd0(%rbp), %xmm0
callq 0x8150
mulsd -0xb8(%rbp), %xmm0
movsd -0xe8(%rbp), %xmm1
mulsd -0x68(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, (%rbx)
movsd -0xd0(%rbp), %xmm0
callq 0x8150
movsd %xmm0, -0xe8(%rbp)
movsd -0xd0(%rbp), %xmm0
callq 0x8c00
mulsd -0xb8(%rbp), %xmm0
movsd -0xe8(%rbp), %xmm1
mulsd -0x68(%rbp), %xmm1
subsd %xmm1, %xmm0
movsd %xmm0, 0x8(%rbx)
movsd -0x130(%rbp), %xmm0
movsd %xmm0, 0x10(%rbx)
leaq 0x13972(%rip), %rsi     # 0x79490
movq %r13, %rdi
callq 0x8160
testq %rax, %rax
jne 0x6623f
movaps 0x4f9a(%rip), %xmm0     # 0x6aad0
xorps -0xb0(%rbp), %xmm0
movaps %xmm0, -0xd0(%rbp)
movsd -0x40(%rbp), %xmm0
callq 0x8c00
movapd -0x150(%rbp), %xmm1
mulsd %xmm0, %xmm1
movsd 0x3dbe(%rip), %xmm0     # 0x69920
addsd %xmm0, %xmm1
movsd -0xf0(%rbp), %xmm0
divsd %xmm1, %xmm0
movsd %xmm0, -0xf0(%rbp)
movapd -0x120(%rbp), %xmm0
mulsd 0x60ee(%rip), %xmm0     # 0x6bc78
movapd %xmm0, -0x120(%rbp)
callq 0x8c00
movsd %xmm0, -0x70(%rbp)
movapd -0x120(%rbp), %xmm0
callq 0x8c00
mulsd -0x70(%rbp), %xmm0
movsd %xmm0, -0x70(%rbp)
movsd 0x60bd(%rip), %xmm0     # 0x6bc78
mulsd -0x40(%rbp), %xmm0
movsd %xmm0, -0xb8(%rbp)
callq 0x8c00
movsd %xmm0, -0x68(%rbp)
movsd -0xb8(%rbp), %xmm0
callq 0x8c00
movapd %xmm0, %xmm3
mulsd -0x68(%rbp), %xmm3
movapd -0x90(%rbp), %xmm2
movapd %xmm2, %xmm0
movsd 0x3d24(%rip), %xmm1     # 0x69920
addsd %xmm1, %xmm0
subsd %xmm2, %xmm1
divsd %xmm1, %xmm0
xorpd %xmm1, %xmm1
ucomisd %xmm1, %xmm0
jb 0x65c18
sqrtsd %xmm0, %xmm0
jmp 0x65c2f
movsd %xmm3, -0x68(%rbp)
callq 0x84e0
movsd -0x68(%rbp), %xmm3
movapd -0x90(%rbp), %xmm2
movsd -0x70(%rbp), %xmm1
mulsd %xmm0, %xmm1
movsd -0xf0(%rbp), %xmm0
mulsd %xmm0, %xmm1
divsd %xmm3, %xmm1
movsd %xmm1, -0x70(%rbp)
movsd -0x98(%rbp), %xmm1
mulsd %xmm2, %xmm1
mulsd %xmm0, %xmm1
movsd %xmm1, -0x98(%rbp)
movsd -0x40(%rbp), %xmm0
callq 0x8150
movsd 0x90(%r12), %xmm4
movsd -0x128(%rbp), %xmm3
mulsd %xmm3, %xmm4
movsd 0x30(%r12), %xmm1
movsd -0x100(%rbp), %xmm2
mulsd %xmm2, %xmm1
subsd %xmm4, %xmm1
addsd %xmm1, %xmm1
movsd -0x70(%rbp), %xmm4
mulsd %xmm4, %xmm1
mulsd -0x98(%rbp), %xmm0
addsd %xmm1, %xmm0
movsd %xmm0, -0x68(%rbp)
movsd 0x48(%r12), %xmm1
movsd 0x58(%r12), %xmm0
addsd %xmm0, %xmm0
mulsd %xmm2, %xmm0
addsd 0x3c48(%rip), %xmm0     # 0x69920
mulsd 0x6128(%rip), %xmm1     # 0x6be08
mulsd %xmm3, %xmm1
addsd %xmm0, %xmm1
mulsd %xmm4, %xmm1
movsd %xmm1, -0xb8(%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, -0x98(%rbp)
leaq 0x1374a(%rip), %rsi     # 0x7947c
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x65d93
leaq 0x1373a(%rip), %rsi     # 0x79480
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x65d93
leaq 0x1372a(%rip), %rsi     # 0x79484
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x65d93
leaq 0x1371a(%rip), %rsi     # 0x79488
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x65d93
leaq 0x1370a(%rip), %rsi     # 0x7948c
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
je 0x6626b
movsd 0xa0(%r12), %xmm0
movsd %xmm0, -0x70(%rbp)
movsd -0x60(%rbp), %xmm0
callq 0x8c00
movsd %xmm0, -0x40(%rbp)
movsd -0x60(%rbp), %xmm0
callq 0x8150
mulsd -0x78(%rbp), %xmm0
mulsd -0xb8(%rbp), %xmm0
movsd -0x40(%rbp), %xmm1
mulsd -0x68(%rbp), %xmm1
subsd %xmm0, %xmm1
movsd %xmm1, -0x40(%rbp)
movsd -0x60(%rbp), %xmm0
callq 0x8150
movsd %xmm0, -0x90(%rbp)
movsd -0x60(%rbp), %xmm0
callq 0x8c00
mulsd -0x78(%rbp), %xmm0
mulsd -0xb8(%rbp), %xmm0
movsd -0x90(%rbp), %xmm1
mulsd -0x68(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, -0x90(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8c00
movsd %xmm0, -0x60(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8c00
movsd %xmm0, -0x78(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8150
movsd -0x78(%rbp), %xmm1
mulsd -0x90(%rbp), %xmm1
mulsd %xmm0, %xmm1
movsd -0x60(%rbp), %xmm0
mulsd -0x40(%rbp), %xmm0
subsd %xmm1, %xmm0
movsd %xmm0, -0x60(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8150
mulsd -0xb0(%rbp), %xmm0
movsd %xmm0, -0x78(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8150
mulsd -0x78(%rbp), %xmm0
mulsd -0x98(%rbp), %xmm0
addsd -0x60(%rbp), %xmm0
movsd %xmm0, -0x60(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8150
mulsd -0xe0(%rbp), %xmm0
mulsd -0x70(%rbp), %xmm0
movsd -0x60(%rbp), %xmm1
subsd %xmm0, %xmm1
movsd %xmm1, -0x60(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8c00
movsd %xmm0, -0x78(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8c00
movsd -0x78(%rbp), %xmm1
mulsd -0xd0(%rbp), %xmm1
mulsd %xmm0, %xmm1
mulsd -0x70(%rbp), %xmm1
addsd -0x60(%rbp), %xmm1
movsd %xmm1, 0x18(%rbx)
movsd -0x30(%rbp), %xmm0
callq 0x8150
movsd %xmm0, -0x60(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8c00
mulsd -0x90(%rbp), %xmm0
movsd %xmm0, -0x78(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8c00
mulsd -0x78(%rbp), %xmm0
movsd -0x60(%rbp), %xmm1
mulsd -0x40(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, -0x60(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8c00
movsd %xmm0, -0x40(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8150
movsd -0x40(%rbp), %xmm1
mulsd -0xd0(%rbp), %xmm1
mulsd %xmm0, %xmm1
mulsd -0x98(%rbp), %xmm1
addsd -0x60(%rbp), %xmm1
movsd %xmm1, -0x40(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8c00
mulsd -0xe0(%rbp), %xmm0
mulsd -0x70(%rbp), %xmm0
addsd -0x40(%rbp), %xmm0
movsd %xmm0, -0x60(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8c00
movsd %xmm0, -0x40(%rbp)
movsd -0x30(%rbp), %xmm0
callq 0x8150
movsd -0x40(%rbp), %xmm1
mulsd -0xd0(%rbp), %xmm1
mulsd %xmm0, %xmm1
mulsd -0x70(%rbp), %xmm1
addsd -0x60(%rbp), %xmm1
movsd %xmm1, 0x20(%rbx)
movsd -0x38(%rbp), %xmm0
callq 0x8150
movsd %xmm0, -0x30(%rbp)
movsd -0x38(%rbp), %xmm0
callq 0x8c00
mulsd -0xb0(%rbp), %xmm0
mulsd -0x98(%rbp), %xmm0
movsd -0x30(%rbp), %xmm1
mulsd -0x90(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, -0x30(%rbp)
movsd %xmm1, 0x28(%rbx)
leaq 0x13454(%rip), %rsi     # 0x7947c
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x66089
leaq 0x13444(%rip), %rsi     # 0x79480
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x66089
leaq 0x13434(%rip), %rsi     # 0x79484
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x66089
leaq 0x13424(%rip), %rsi     # 0x79488
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
jne 0x66089
leaq 0x13414(%rip), %rsi     # 0x7948c
movq %r14, %rdi
callq 0x8160
testq %rax, %rax
je 0x6623f
movsd 0x18(%rbx), %xmm0
movsd %xmm0, -0x38(%rbp)
movsd 0x20(%rbx), %xmm1
movsd -0x30(%rbp), %xmm2
movapd %xmm2, %xmm0
mulsd 0x132c7(%rip), %xmm0    # 0x79370
movsd 0x132c7(%rip), %xmm3    # 0x79378
movapd %xmm1, %xmm4
mulsd %xmm3, %xmm4
addsd %xmm0, %xmm4
movsd %xmm4, -0x60(%rbp)
mulsd %xmm3, %xmm2
mulsd 0x132b2(%rip), %xmm1    # 0x79380
addsd %xmm2, %xmm1
movsd %xmm1, -0x30(%rbp)
movsd -0x48(%rbp), %xmm0
mulsd -0xa0(%rbp), %xmm0
movsd %xmm0, -0x48(%rbp)
callq 0x8c00
movsd %xmm0, -0x90(%rbp)
movsd -0x48(%rbp), %xmm0
callq 0x8150
mulsd -0x60(%rbp), %xmm0
movsd -0x90(%rbp), %xmm1
mulsd -0x38(%rbp), %xmm1
addsd %xmm0, %xmm1
movsd %xmm1, -0x90(%rbp)
movsd -0x48(%rbp), %xmm0
callq 0x8150
movsd %xmm0, -0xb0(%rbp)
movsd -0x48(%rbp), %xmm0
callq 0x8c00
mulsd -0x60(%rbp), %xmm0
movsd -0xb0(%rbp), %xmm1
mulsd -0x38(%rbp), %xmm1
subsd %xmm1, %xmm0
movsd %xmm0, -0x38(%rbp)
movsd -0xf8(%rbp), %xmm0
mulsd 0x1320b(%rip), %xmm0    # 0x79370
movsd -0xd8(%rbp), %xmm1
mulsd 0x13203(%rip), %xmm1    # 0x79378
addsd %xmm0, %xmm1
movsd %xmm1, -0xd8(%rbp)
movaps 0x4948(%rip), %xmm0     # 0x6aad0
xorps -0x140(%rbp), %xmm0
movaps %xmm0, -0x60(%rbp)
movsd -0x48(%rbp), %xmm0
callq 0x8150
movsd %xmm0, -0xb0(%rbp)
movsd -0x48(%rbp), %xmm0
callq 0x8c00
mulsd -0xd8(%rbp), %xmm0
movsd -0xb0(%rbp), %xmm1
mulsd -0x140(%rbp), %xmm1
subsd %xmm1, %xmm0
mulsd -0xa0(%rbp), %xmm0
movsd %xmm0, 0x18(%rbx)
movsd -0x48(%rbp), %xmm0
callq 0x8c00
movsd %xmm0, -0xb0(%rbp)
movsd -0x48(%rbp), %xmm0
callq 0x8150
mulsd -0xd8(%rbp), %xmm0
movsd -0xb0(%rbp), %xmm1
mulsd -0x60(%rbp), %xmm1
subsd %xmm0, %xmm1
mulsd -0xa0(%rbp), %xmm1
addsd -0x38(%rbp), %xmm1
movsd -0x90(%rbp), %xmm0
addsd 0x18(%rbx), %xmm0
movsd %xmm0, 0x18(%rbx)
movsd %xmm1, 0x20(%rbx)
xorpd %xmm0, %xmm0
addsd -0x30(%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 -0xa0(%rbp), %xmm0
jmp 0x658c5
movsd 0xa0(%r12), %xmm0
subsd -0xa0(%rbp), %xmm0
jmp 0x65d9d