Function reset_solid_level_set_callback_fcn

examples/IBLevelSet/ex4/example.cpp:71–182

};

void
reset_solid_level_set_callback_fcn(double current_time, double new_time, int /*cycle_num*/, void* ctx)
{
    SolidLevelSetResetter* resetter = static_cast<SolidLevelSetResetter*>(ctx);
    const FoilInterface& foil = *(resetter->ptr_foil);

    // Get the new centroid of the body
    const double dt = new_time - current_time;
    const Eigen::Vector3d XCOM_current = resetter->bp_rbd->getCurrentCOMPosn();
    const Eigen::Vector3d XCOM_new = XCOM_current + dt * (resetter->bp_rbd->getNewCOMTransVelocity());

    // b) Rotational matrix.
    const double theta = foil.theta_0 * std::sin(2 * M_PI * foil.freq * new_time);

    const Eigen::Vector3d rot_axis(0.0, 0.0, 1.0);
    Eigen::Quaterniond q(Eigen::AngleAxisd(theta, rot_axis));
    q.normalize();

    const Eigen::Matrix3d R_mat = q.toRotationMatrix();

    const double& R = foil.R;
    const Eigen::Vector3d& X0 = foil.X0;
    const Eigen::Vector3d& X1 = foil.X1;
    const Eigen::Vector3d& X2 = foil.X2;
    const Eigen::Vector3d& X3 = foil.X3;
    Eigen::Vector3d check1, check2, check3, check4, check5, check6;

    // Rotate and translate the top, bottom and circular surface to get new coordiantes.
    const Eigen::Vector3d X1_new = R_mat * (X1 - X0) + XCOM_new;
    const Eigen::Vector3d X2_new = R_mat * (X2 - X0) + XCOM_new;
    const Eigen::Vector3d X3_new = R_mat * (X3 - X0) + XCOM_new;

    const Eigen::Vector3d X_T_new = (X1_new + X2_new + X3_new) / 3.0;

    const double slope1 = (X3_new[1] - X1_new[1]) / (X3_new[0] - X1_new[0]);
    const double slope2 = (X3_new[1] - X2_new[1]) / (X3_new[0] - X2_new[0]);
    const double slope3 = (X2_new[0] - X1_new[0]) / (X2_new[1] - X1_new[1]);

    const double y_intercept1 = X1_new[1] - slope1 * X1_new[0];
    const double y_intercept2 = X2_new[1] - slope2 * X2_new[0];
    const double x_intercept3 = X1_new[0] - slope3 * X1_new[1];

    double distance1[2], distance2[3]; // Foil has three surfaces and 1 surface for circle.

    // Set a large value away from the solid body.
    Pointer<PatchHierarchy<NDIM>> patch_hier = resetter->adv_diff_integrator->getPatchHierarchy();
    const int hier_finest_ln = patch_hier->getFinestLevelNumber();

    VariableDatabase<NDIM>* var_db = VariableDatabase<NDIM>::getDatabase();
    const int ls_solid_idx =
        var_db->mapVariableAndContextToIndex(resetter->ls_solid_var, resetter->adv_diff_integrator->getNewContext());

    for (int ln = 0; ln <= hier_finest_ln; ++ln)
    {
        Pointer<PatchLevel<NDIM>> patch_level = patch_hier->getPatchLevel(ln);
        for (PatchLevel<NDIM>::Iterator p(patch_level); p; p++)
        {
            Pointer<Patch<NDIM>> patch = patch_level->getPatch(p());