ConeRigidBody Struct Reference

#include <users_modules/multifield_plasticity/src/RigidBodies.hpp>

Inheritance diagram for ConeRigidBody:

Collaboration diagram for ConeRigidBody:

Public Member Functions
	ConeRigidBody (VectorDouble c_coords, VectorDouble roller_disp, int id)
MoFEMErrorCode	getRollerDataForTag ()
Tensor1< double, 3 >	getNormal (Tensor1< TPack3, 3 > &t_coords, Tensor1< TPack1, 3 > &t_disp)
Tensor1< double, 3 >	getNormal (Tensor1< TPack3, 3 > &t_coords, Tensor1< double, 3 > &t_disp)
Tensor1< double, 3 >	getNormal (Tensor1< double, 3 > &t_coords, Tensor1< double, 3 > &t_disp)
Tensor2< double, 3, 3 >	getDiffNormal (Tensor1< TPack3, 3 > &t_coords, Tensor1< TPack1, 3 > &t_disp, Tensor1< TPack1, 3 > &t_normal)
double	getGap (Tensor1< TPack3, 3 > &t_coords)
Tensor1< double, 3 >	getdGap (Tensor1< TPack3, 3 > &t_coords, Tensor1< TPack1, 3 > &t_normal)
template<typename T1 , typename T2 >
Tensor1< double, 3 > &	getNormalImpl (Tensor1< T1, 3 > &t_coords, Tensor1< T2, 3 > &t_disp)
template<typename T1 >
double	getGapImpl (Tensor1< T1, 3 > &t_coords)
template<typename T1 , typename T2 , typename T3 >
Tensor2< double, 3, 3 >	getDiffNormalImpl (Tensor1< T1, 3 > &t_coords, Tensor1< T2, 3 > &t_disp, Tensor1< T3, 3 > &t_normal)
template<typename T1 , typename T2 >
Tensor1< double, 3 >	getdGapImpl (Tensor1< T1, 3 > &t_coords, Tensor1< T2, 3 > &t_normal)
virtual MoFEMErrorCode	getBodyOptions ()
Public Member Functions inherited from RigidBodyData
	RigidBodyData (VectorDouble c_coords, VectorDouble roller_disp, int id)
	RigidBodyData ()=delete
virtual	~RigidBodyData ()
virtual Tensor1< double, 3 >	getNormal (Tensor1< TPack3, 3 > &t_coords, Tensor1< TPack1, 3 > &t_disp)=0
virtual Tensor1< double, 3 >	getNormal (Tensor1< TPack3, 3 > &t_coords, Tensor1< double, 3 > &t_disp)=0
virtual Tensor1< double, 3 >	getNormal (Tensor1< double, 3 > &t_coords, Tensor1< double, 3 > &t_disp)=0
virtual Tensor2< double, 3, 3 >	getDiffNormal (Tensor1< TPack3, 3 > &t_coords, Tensor1< TPack1, 3 > &t_disp, Tensor1< TPack1, 3 > &t_normal)=0
virtual double	getGap (Tensor1< TPack3, 3 > &t_coords)=0
virtual Tensor1< double, 3 >	getdGap (Tensor1< TPack3, 3 > &t_coords, Tensor1< TPack1, 3 > &t_normal)=0
virtual MoFEMErrorCode	getBodyOptions ()=0
MoFEMErrorCode	computeRotationMatrix ()
Tensor1< double, 3 >	getBodyOffset ()
template<typename T1 , typename T2 >
Tensor1< double, 3 > &	getPointCoords (Tensor1< T1, 3 > &t_coords, Tensor1< T2, 3 > &t_disp)
MoFEMErrorCode	saveBasicDataOnTag (moab::Interface &moab_debug, EntityHandle &vertex)
virtual MoFEMErrorCode	getRollerDataForTag ()=0

Public Attributes
shared_ptr< ArbitrarySurfaceData >	cP
double	sLope
double	hEight
double	rAdius
double	smallRadius
double	oFfset
double	aNgle
Public Attributes inherited from RigidBodyData
const int	iD
Index< 'i', 3 >	i
Index< 'j', 3 >	j
Index< 'k', 3 >	k
VectorDouble	originCoords
VectorDouble	rollerDisp
VectorDouble	BodyDispScaled
VectorDouble	BodyDirectionScaled
double	gAp
Tensor1< double, 3 >	tNormal
Tensor1< double, 3 >	dGap
Tensor1< double, 3 >	pointCoords
Tensor1< double, 3 >	closestPoint
Tensor1< double, 3 >	defaultOrientation
Tensor1< double, 3 >	oRientation
Tensor2< double, 3, 3 >	rotationMat
Tensor2< double, 3, 3 >	diffNormal
boost::shared_ptr< TimeAccelerogram >	methodOpForRollerPosition
boost::shared_ptr< TimeAccelerogram >	methodOpForRollerDirection
int	bodyType
array< double, 9 >	dataForTags

Additional Inherited Members
Public Types inherited from RigidBodyData
using	TPack3 = PackPtr< double *, 3 >
using	TPack1 = PackPtr< double *, 1 >

Detailed Description

Definition at line 990 of file RigidBodies.hpp.

Constructor & Destructor Documentation

ConeRigidBody()

ConeRigidBody::ConeRigidBody ( VectorDouble  c_coords, VectorDouble  roller_disp, int  id  )

inline

Definition at line 999 of file RigidBodies.hpp.

      : RigidBodyData(c_coords, roller_disp, id) {
    // , cP(R, r, 1)
    sLope = 1;
    hEight = 1;
    rAdius = 1;
    oFfset = 0;
    // compute rotation matrix here
  }

Member Function Documentation

getBodyOptions()

virtual MoFEMErrorCode ConeRigidBody::getBodyOptions ( )

inlinevirtual

Implements RigidBodyData.

Definition at line 1209 of file RigidBodies.hpp.

                                          {
    MoFEMFunctionBegin;
    PetscBool rflg;
    int nb_dirs = 3;
    double angle = 45;
    CHKERR PetscOptionsBegin(PETSC_COMM_WORLD, "", "", "");
    string param = "-radius" + to_string(iD);
    CHKERR PetscOptionsScalar(param.c_str(), "set cone radius", "", rAdius,
                              &rAdius, PETSC_NULL);
    param = "-height" + to_string(iD);
    CHKERR PetscOptionsScalar(param.c_str(), "set cone height", "", hEight,
                              &hEight, PETSC_NULL);
    param = "-angle" + to_string(iD);
    CHKERR PetscOptionsScalar(param.c_str(), "set cone half angle", "", angle,
                              &angle, PETSC_NULL);
    param = "-direction" + to_string(iD);
    CHKERR PetscOptionsGetRealArray(NULL, NULL, param.c_str(), &oRientation(0),
                                    &nb_dirs, &rflg);
    ierr = PetscOptionsEnd();
    CHKERRG(ierr);
    aNgle = angle;
    sLope = std::tan(aNgle * M_PI / 180);
    oFfset = (rAdius / sLope) - hEight;
    smallRadius = rAdius * oFfset / (oFfset + hEight);
 
    if (rflg)
      CHKERR computeRotationMatrix();
 
    cP = make_shared<ArbitrarySurfaceData>(1, sLope);
 
    MoFEMFunctionReturn(0);
  }

getdGap()

Tensor1< double, 3 > ConeRigidBody::getdGap ( Tensor1< TPack3, 3 > &  t_coords, Tensor1< TPack1, 3 > &  t_normal  )

inlinevirtual

Implements RigidBodyData.

Definition at line 1040 of file RigidBodies.hpp.

                                                           {
    return getdGapImpl(t_coords, t_normal);
  }

getdGapImpl()

template<typename T1 , typename T2 >

Tensor1< double, 3 > ConeRigidBody::getdGapImpl ( Tensor1< T1, 3 > &  t_coords, Tensor1< T2, 3 > &  t_normal  )

inline

Definition at line 1204 of file RigidBodies.hpp.

                                                                  {
    return dGap;
  };

getDiffNormal()

Tensor2< double, 3, 3 > ConeRigidBody::getDiffNormal ( Tensor1< TPack3, 3 > &  t_coords, Tensor1< TPack1, 3 > &  t_disp, Tensor1< TPack1, 3 > &  t_normal  )

inlinevirtual

Implements RigidBodyData.

Definition at line 1031 of file RigidBodies.hpp.

                                                                    {
    return getDiffNormalImpl(t_coords, t_disp, t_normal);
  }

getDiffNormalImpl()

template<typename T1 , typename T2 , typename T3 >

Tensor2< double, 3, 3 > ConeRigidBody::getDiffNormalImpl ( Tensor1< T1, 3 > &  t_coords, Tensor1< T2, 3 > &  t_disp, Tensor1< T3, 3 > &  t_normal  )

inline

Definition at line 1182 of file RigidBodies.hpp.

                                                                           {
    Tensor2<double, 3, 3> diff_normal;
    Tensor1<double, 3> norm_diff;
    const double clean_gap = gAp;
    const double eps = 1e-8;
    for (int ii = 0; ii != 3; ++ii) {
      Tensor1<double, 3> pert_disp{t_disp(0), t_disp(1), t_disp(2)};
      pert_disp(ii) += eps;
      auto pert_normal = getNormal(t_coords, pert_disp);
      norm_diff(i) = (pert_normal(i) - t_normal(i)) / eps;
      dGap(ii) = (gAp - clean_gap) / eps;
 
      for (int jj = 0; jj != 3; ++jj) {
        diff_normal(jj, ii) = norm_diff(jj);
      }
    }
    return diff_normal;
  };

getGap()

double ConeRigidBody::getGap ( Tensor1< TPack3, 3 > &  t_coords )

inlinevirtual

Implements RigidBodyData.

Definition at line 1037 of file RigidBodies.hpp.

                                                     {
    return getGapImpl(t_coords);
  }

getGapImpl()

template<typename T1 >

double ConeRigidBody::getGapImpl ( Tensor1< T1, 3 > &  t_coords )

inline

Definition at line 1177 of file RigidBodies.hpp.

                                                                            {
    return gAp;
  };

getNormal() [1/3]

Tensor1< double, 3 > ConeRigidBody::getNormal ( Tensor1< double, 3 > &  t_coords, Tensor1< double, 3 > &  t_disp  )

inlinevirtual

Implements RigidBodyData.

Definition at line 1026 of file RigidBodies.hpp.

                                                           {
    return getNormalImpl(t_coords, t_disp);
  }

getNormal() [2/3]

Tensor1< double, 3 > ConeRigidBody::getNormal ( Tensor1< TPack3, 3 > &  t_coords, Tensor1< double, 3 > &  t_disp  )

inlinevirtual

Implements RigidBodyData.

Definition at line 1022 of file RigidBodies.hpp.

                                                           {
    return getNormalImpl(t_coords, t_disp);
  }

getNormal() [3/3]

Tensor1< double, 3 > ConeRigidBody::getNormal ( Tensor1< TPack3, 3 > &  t_coords, Tensor1< TPack1, 3 > &  t_disp  )

inlinevirtual

Implements RigidBodyData.

Definition at line 1018 of file RigidBodies.hpp.

                                                           {
    return getNormalImpl(t_coords, t_disp);
  }

getNormalImpl()

template<typename T1 , typename T2 >

Tensor1< double, 3 > & ConeRigidBody::getNormalImpl ( Tensor1< T1, 3 > &  t_coords, Tensor1< T2, 3 > &  t_disp  )

inline

Definition at line 1046 of file RigidBodies.hpp.

                                                                   {
 
    auto t_d = getPointCoords(t_coords, t_disp);
    CHKERR computeRotationMatrix();
    pointCoords(i) = rotationMat(i, j) * t_d(j);
    t_d(i) = pointCoords(i);
 
    // Tensor1<double, 3> c_center(0., 0., 0.);
    // Tensor1<double, 3> q_minus_c(0., 0., 0.);
    // Tensor1<double, 3> K(0., 0., 0.);
    // auto Q = pointCoords;
    // auto P_Q = pointCoords;
    // auto Q_K = pointCoords;
 
    const double half_height = hEight / 2.;
    // const double rad2 = rAdius * rAdius;
    // const double small_rad2 = smallRadius * smallRadius;
 
    // tNormal(i) = 0.;
    // pointCoords(2) += (oFfset + half_height);
    // t_d(2) += oFfset + half_height;
    // if (t_d(2) > half_height) {
    //   tNormal(2) = 1;
    //   if (pow(t_d(1), 2) + pow(t_d(0), 2) < rad2) {
    //     gAp = tNormal(i) * t_d(i) - half_height;
    //   } else {
    //     c_center(2) = half_height;
    //     Q(2) = c_center(2); // Q
    //     q_minus_c(i) = Q(i) - c_center(i);
    //     q_minus_c.normalize();
    //     K(i) = c_center(i) + rAdius * q_minus_c(i);
    //     P_Q(i) = t_d(i) - Q(i);
    //     Q_K(i) = Q(i) - K(i);
    //     gAp = sqrt(P_Q.l2() * P_Q.l2() + Q_K.l2() * Q_K.l2());
    //   }
    // } else if (t_d(2) < -half_height) {
    //   tNormal(2) = -1;
    //   if (pow(t_d(1), 2) + pow(t_d(0), 2) < small_rad2) {
    //     gAp = tNormal(i) * t_d(i) - half_height;
    //   } else {
    //     c_center(2) = -half_height;
    //     Q(2) = c_center(2); // Q
    //     q_minus_c(i) = Q(i) - c_center(i);
    //     q_minus_c.normalize();
    //     K(i) = c_center(i) + smallRadius * q_minus_c(i);
    //     P_Q(i) = t_d(i) - Q(i);
    //     Q_K(i) = Q(i) - K(i);
    //     gAp = sqrt(P_Q.l2() * P_Q.l2() + Q_K.l2() * Q_K.l2());
    //   }
    // } else {
    //   auto closest_pt_cone = cP->getClosestPointToCone(t_d);
    //   closestPoint(i) = closest_pt_cone(i);
 
    //   tNormal(j) = t_d(j) - closestPoint(j);
    //   auto test_normal = tNormal.l2();
    //   if (cP->isPointInsideCone(t_d))
    //     tNormal(i) *= -1;
    //   tNormal.normalize();
 
    //   gAp = tNormal(i) * (t_d(i) - closestPoint(i));
    // }
 
    auto clamp = [](auto x, auto min, auto max) {
      if (x < min)
        x = min;
      else if (x > max)
        x = max;
      return x;
    };
 
    auto sd_capped_cone = [&](Tensor1<double, 3> p, double h, double r1,
                              double r2) {
      typedef Tensor1<double, 2> vec2;
      Index<'i', 2> i;
      vec2 cb;
      vec2 q(sqrt(p(i) * p(i)), p(2));
      vec2 k1(r2, h);
      vec2 k2(r2 - r1, 2.0 * h);
      vec2 ca(q(0) - std::min(q(0), (q(1) < 0.0) ? r1 : r2), abs(q(1)) - h);
      vec2 k1_q(k1(0) - q(0), k1(1) - q(1));
      cb(i) = q(i) - k1(i) +
              k2(i) * clamp((k1_q(i) * k2(i)) / (k2(i) * k2(i)), 0.0, 1.0);
      double s = (cb(0) < 0.0 && ca(1) < 0.0) ? -1.0 : 1.0;
      return s * sqrt(std::min((ca(i) * ca(i)), (cb(i) * cb(i))));
    };
 
    const double eps = 1e-6;
    auto cone_distance =
        sd_capped_cone(pointCoords, half_height, rAdius, smallRadius);
 
    auto get_d = [&](int a) {
      auto pt = pointCoords;
      pt(a) += eps;
      return (sd_capped_cone(pt, half_height, rAdius, smallRadius) -
              cone_distance) /
             eps;
    };
 
    // for debugging
    // auto my_rand_mn = [](double M, double N) {
    //   return M + (rand() / (RAND_MAX / (N - M)));
    // };
    // auto t_off = getBodyOffset();
    // std::ofstream afile("cone_pts.csv", std::ios::ate);
    // if (afile.is_open()) {
    //   afile << "X,Y,Z\n";
    //   Tensor1<double, 3> p(0, 0, 0);
    //   for (int n = 0; n != 1e6; n++) {
    //     double x = my_rand_mn(-3, 3);
    //     double y = my_rand_mn(-3, 3);
    //     double z = my_rand_mn(-3, 3);
    //     Tensor1<double, 3> coords(x, y, z);
    //     if (sd_capped_cone(coords, half_height, rAdius, smallRadius) < 0) {
 
    //       afile << x + t_off(0) << "," << y + t_off(1) << "," << z + t_off(2)
    //       << "\n";
    //     }
    //   }
    //   afile.close();
    // }
 
    Tensor1<double, 3> my_normal(get_d(0), get_d(1), get_d(2));
    my_normal.normalize();
 
    gAp = cone_distance;
    tNormal(i) = rotationMat(j, i) * my_normal(j);
 
    return tNormal;
  };

getRollerDataForTag()

MoFEMErrorCode ConeRigidBody::getRollerDataForTag ( )

inlinevirtual

Implements RigidBodyData.

Definition at line 1009 of file RigidBodies.hpp.

                                       {
    MoFEMFunctionBeginHot;
    bodyType = CONE;
    dataForTags[0] = rAdius;
    dataForTags[2] = hEight;
    dataForTags[3] = aNgle;
    MoFEMFunctionReturnHot(0);
  }

Member Data Documentation

aNgle

double ConeRigidBody::aNgle

Definition at line 998 of file RigidBodies.hpp.

cP

shared_ptr<ArbitrarySurfaceData> ConeRigidBody::cP

Definition at line 991 of file RigidBodies.hpp.

hEight

double ConeRigidBody::hEight

Definition at line 993 of file RigidBodies.hpp.

oFfset

double ConeRigidBody::oFfset

Definition at line 996 of file RigidBodies.hpp.

rAdius

double ConeRigidBody::rAdius

Definition at line 994 of file RigidBodies.hpp.

sLope

double ConeRigidBody::sLope

Definition at line 992 of file RigidBodies.hpp.

smallRadius

double ConeRigidBody::smallRadius

Definition at line 995 of file RigidBodies.hpp.

---

The documentation for this struct was generated from the following file:

• users_modules/multifield_plasticity/src/RigidBodies.hpp