phigrape/black_holes.cpp

255 lines
9.7 KiB
C++

#include <cstdio>
#include <numeric>
#include "black_holes.h"
// TODO do not include c files!
#define SQR(x) ((x)*(x))
double L[3]; // needed in pn_bh_spin.c
#include "n_bh.c"
#include "pn_bh_spin.c"
void two_body_gravity(
const double m1, const double3 x1, const double3 v1,
const double m2, const double3 x2, const double3 v2,
const double eps,
double& pot1, double3& acc1, double3& jrk1,
double& pot2, double3& acc2, double3& jrk2)
{
double3 dx = x1 - x2;
double3 dv = v1 - v2;
double r2 = dx.norm2() + eps*eps;
double r = sqrt(r2);
double r3 = r2*r;
double r4 = r2*r2;
double RP = 3*(dx*dv)/r;
pot1 = -m2/r;
pot2 = -m1/r;
acc1 = -m2*dx/r3;
acc2 = m1*dx/r3;
jrk1 = -m2*(dv/r3 - RP*dx/r4);
jrk2 = m1*(dv/r3 - RP*dx/r4);
}
// class Black_hole_physics {
// public:
// Black_hole_physics()
// : count(0), c(0) {}
// Black_hole_physics(const double m1, const double m2, const int myRank, const int rootRank)
// : m1(m1), m2(m2), count(2), c(0), myRank(myRank), rootRank(rootRank) {}
// void set_post_newtonian(const double c, const int pn_usage[7])
// {
// this->c = c;
// std::copy(pn_usage, pn_usage+7, this->pn_usage);
// }
// void set_spins(const double spin1[3], const double spin2[3])
// {
// std::copy(spin1, spin1+3, this->bbh_grav.spin1);
// std::copy(spin2, spin2+3, this->bbh_grav.spin2);
// }
// void set_xv(const double3& x1, const double3& x2, const double3& v1, const double3& v2)
// {
// this->x1 = x1;
// this->x2 = x2;
// this->v1 = v1;
// this->v2 = v2;
// }
// void set_softening(const double eps_old, const double eps_new)
// {
// this->eps_old = eps_old;
// this->eps_new = eps_new;
// }
// void adjust_softening(
// double& pot1, double& pot2,
// double3& acc1, double3& acc2,
// double3& jrk1, double3& jrk2);
// void adjust_post_newtonian(
// const double dt_bh, // pn_usage should be const
// double3& acc1, double3& acc2,
// double3& jrk1, double3& jrk2);
// void write_bh_data(double time_cur, double m[], double3 x[], double3 v[], double pot[], double3 a[], double3 adot[], double dt[]);
// public: //TODO make private
// double m1, m2;
// int count;
// int myRank, rootRank;
// double eps_old, eps_new;
// double3 x1, v1, x2, v2;
// double c;
// int pn_usage[7];
// Bbh_gravity bbh_grav;
// };
void Black_hole_physics::adjust_softening(
double& pot1, double& pot2,
double3& acc1, double3& acc2,
double3& jrk1, double3& jrk2)
{
if (eps_new < 0) return;
// calculate and "minus" the BH <-> BH softened pot, acc & jerk
two_body_gravity(
m1, x1, v1,
m2, x2, v2,
eps_old,
bbh_grav.pot1, bbh_grav.a1, bbh_grav.adot1,
bbh_grav.pot2, bbh_grav.a2, bbh_grav.adot2);
pot1 -= bbh_grav.pot1;
pot2 -= bbh_grav.pot2;
acc1 -= bbh_grav.a1;
acc2 -= bbh_grav.a2;
jrk1 -= bbh_grav.adot1;
jrk2 -= bbh_grav.adot2;
// calculate and "plus" the new BH <-> BH unsoftened pot, acc, jerk
two_body_gravity(
m1, x1, v1,
m2, x2, v2,
eps_new,
bbh_grav.pot1, bbh_grav.a1, bbh_grav.adot1,
bbh_grav.pot2, bbh_grav.a2, bbh_grav.adot2);
pot1 += bbh_grav.pot1;
pot2 += bbh_grav.pot2;
acc1 += bbh_grav.a1;
acc2 += bbh_grav.a2;
jrk1 += bbh_grav.adot1;
jrk2 += bbh_grav.adot2;
}
void Black_hole_physics::adjust_post_newtonian(
const double dt_bh, // pn_usage should be const
double3& acc1, double3& acc2,
double3& jrk1, double3& jrk2)
{
// calculate and "plus" the new BH <-> BH : PN1, PN2, PN2.5, PN3, PN3.5 : acc, jerk
// TODO maybe have the PN terms as local variables here?
int tmp;
tmp = calc_force_pn_BH(m1, x1, v1, bbh_grav.spin1,
m2, x2, v2, bbh_grav.spin2,
c, dt_bh, pn_usage,
(double(*)[3])bbh_grav.a_pn1, (double(*)[3])bbh_grav.adot_pn1,
(double(*)[3])bbh_grav.a_pn2, (double(*)[3])bbh_grav.adot_pn2, myRank, rootRank);
if (tmp == 505) exit(-1); // Very ugly way to terminate
// NOTE we have these _corr variables accumulating the corrections before
// applying it. It's almost the same but different from applying each
// correction term in a loop.
double3 acc1_corr(0,0,0), acc2_corr(0,0,0), jrk1_corr(0,0,0), jrk2_corr(0,0,0);
for (int i=1; i<7; i++) {
acc1_corr += bbh_grav.a_pn1[i];
acc2_corr += bbh_grav.a_pn2[i];
jrk1_corr += bbh_grav.adot_pn1[i];
jrk2_corr += bbh_grav.adot_pn2[i];
}
acc1 += acc1_corr;
acc2 += acc2_corr;
jrk1 += jrk1_corr;
jrk2 += jrk2_corr;
}
void Black_hole_physics::write_bh_data(double time_cur, double m[], double3 x[], double3 v[], double pot[], double3 a[], double3 adot[], double dt[])
{
// This function logs data on the black hole(s). It uses both external data
// (the arguments to this function) and optionall internal data to this
// object (the most recently calculated force and post-Newtonian terms).
auto out = fopen("bh.dat", "a");
if (count == 2) {
for (int i=0; i < 2; i++) {
double3 *a_pn, *adot_pn, a_bh, adot_bh;
double pot_bh;
if (i==0) {
a_pn = bbh_grav.a_pn1;
adot_pn = bbh_grav.adot_pn1;
pot_bh = bbh_grav.pot1;
a_bh = bbh_grav.a1;
adot_bh = bbh_grav.adot1;
} else {
a_pn = bbh_grav.a_pn2;
adot_pn = bbh_grav.adot_pn2;
pot_bh = bbh_grav.pot2;
a_bh = bbh_grav.a2;
adot_bh = bbh_grav.adot2;
}
if (eps_new >= 0) {
fprintf(out, "%.16E \t %.8E \t % .16E % .16E % .16E \t %.16E \t % .16E % .16E % .16E \t %.16E \t % .8E \t % .8E % .8E % .8E \t %.8E \t % .8E % .8E % .8E \t %.8E \t %.8E \t\t % .8E \t % .8E % .8E % .8E \t %.8E \t % .8E % .8E % .8E \t %.8E ",
time_cur, m[i],
x[i][0], x[i][1], x[i][2], x[i].norm(),
v[i][0], v[i][1], v[i][2], v[i].norm(),
pot[i],
a[i][0], a[i][1], a[i][2], a[i].norm(),
adot[i][0], adot[i][1], adot[i][2], adot[i].norm(),
dt[i],
pot_bh,
a_bh[0], a_bh[1], a_bh[2], a_bh.norm(),
adot_bh[0], adot_bh[1], adot_bh[2], adot_bh.norm());
if (c > 0) {
fprintf(out, "\t");
for (int pn_idx=0; pn_idx < 7; pn_idx++) {
fprintf(out, "\t % .8E % .8E % .8E \t %.8E \t % .8E % .8E % .8E \t %.8E ", a_pn[pn_idx][0], a_pn[pn_idx][1], a_pn[pn_idx][2], a_pn[pn_idx].norm(), adot_pn[pn_idx][0], adot_pn[pn_idx][1], adot_pn[pn_idx][2], adot_pn[pn_idx].norm());
}
}
fprintf(out, "\n");
} else {
fprintf(out,"%.16E \t %.8E \t % .16E % .16E % .16E \t %.16E \t % .16E % .16E % .16E \t %.16E \t % .8E \t % .8E % .8E % .8E \t %.8E \t % .8E % .8E % .8E \t %.8E \t %.8E \n",
time_cur, m[i],
x[i][0], x[i][1], x[i][2], x[i].norm(),
v[i][0], v[i][1], v[i][2], v[i].norm(),
pot[i],
a[i][0], a[i][1], a[i][2], a[i].norm(),
adot[i][0], adot[i][1], adot[i][2], adot[i].norm(),
dt[i]);
}
}
fprintf(out, "\n");
} else if (count == 1) {
fprintf(out,"%.16E \t %.8E \t % .16E % .16E % .16E \t %.16E \t % .16E % .16E % .16E \t %.16E \t % .8E \t % .8E % .8E % .8E \t %.8E \t % .8E % .8E % .8E \t %.8E \t %.8E \n",
time_cur, m[0],
x[0][0], x[0][1], x[0][2], x[0].norm(),
v[0][0], v[0][1], v[0][2], v[0].norm(),
pot[0],
a[0][0], a[0][1], a[0][2], a[0].norm(),
adot[0][0], adot[0][1], adot[0][2], adot[0].norm(),
dt[0]);
fprintf(out,"\n");
}
fclose(out);
}
void write_bh_nb_data(int nb, int smbh_count, double time_cur, int N, double m[], double3 x[], double3 v[])
{
//int nb = config->live_smbh_neighbor_number;
// TODO fix below!!! Should be class members.
int ind_sort[30000];
double var_sort[30000];
//TODO you don't want and probably don't need to allocate these here. Maybe just need size nb, or maybe use as private variables.
auto out = fopen("bh_neighbors.dat", "a");
/* 1st BH */
for (int i_bh=0; i_bh < smbh_count; i_bh++) {
for (int i=0; i<N; i++) var_sort[i] = (x[i]-x[i_bh]).norm();
std::iota(ind_sort, ind_sort+N, 0);
std::partial_sort(ind_sort, ind_sort + nb, ind_sort + N, [&](int i, int j) {return var_sort[i] < var_sort[j];});
fprintf(out,"%.16E \t %07d \t %.8E \t % .8E % .8E % .8E \t % .8E % .8E % .8E \t",
time_cur,
i_bh,
m[i_bh],
x[i_bh][0], x[i_bh][1], x[i_bh][2],
v[i_bh][0], v[i_bh][1], v[i_bh][2]);
for (int j=1; j < nb; j++) {
int i = ind_sort[j];
fprintf(out,"%02d %07d %.8E % .8E % .8E % .8E %.8E % .8E % .8E % .8E %.8E \t",
j, i,
m[i],
x[i][0], x[i][1], x[i][2], (x[i]-x[i_bh]).norm(),
v[i][0], v[i][1], v[i][2], (v[i]-v[i_bh]).norm());
}
fprintf(out,"\n");
}
fprintf(out, "\n"); // this is redundant
fclose(out);
}