1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178
|
/////////////////////////////////////////////////////////////
// //
// Copyright (c) 2003-2014 by The University of Queensland //
// Centre for Geoscience Computing //
// http://earth.uq.edu.au/centre-geoscience-computing //
// //
// Primary Business: Brisbane, Queensland, Australia //
// Licensed under the Open Software License version 3.0 //
// http://www.apache.org/licenses/LICENSE-2.0 //
// //
/////////////////////////////////////////////////////////////
#include "ElasticInteraction.h"
#include "console.h"
CElasticIGP::CElasticIGP():AIGParam(), m_k(0.0)
{}
CElasticIGP::CElasticIGP(const std::string& name,double kn, bool scaling)
: AIGParam(name), m_k(kn), m_scaling(scaling)
{}
CElasticInteraction::CElasticInteraction(
CParticle* p1,
CParticle* p2,
const CElasticIGP& param
)
: APairInteraction(p1,p2)
{
double effR=1.0;
double effA=1.0;
double effL=1.0; // effective radius, cross section and length of the interaction for scaling
// equilibrium distance
double r0=p1->getRad()+p2->getRad();
m_scaling = param.m_scaling;
// scale elastic param
if (m_scaling) {
if(!CParticle::getDo2dCalculations()){
effR=0.5*r0;
}
effL=r0;
effA = effR * effR;
}
m_k=param.m_k*effA/effL;
m_force=Vec3(0.0,0.0,0.0);
}
/*!
Calculate free elastic forces. 23 Flops if in contact, 10 Flops if not
*/
void CElasticInteraction::calcForces()
{
// console.XDebug() << "elastic interaction: [" << m_p1->getID() << " - " << m_p2->getID() << "]" << m_p1->getPos() << m_p2->getPos() << "\n";
Vec3 D=m_p1->getPos()-m_p2->getPos();
double dist=D*D;
double eq_dist=m_p1->getRad()+m_p2->getRad();
if(dist<(eq_dist*eq_dist)){
dist=sqrt(dist);
m_force=D*(m_k*(dist-eq_dist)/dist);
Vec3 pos=m_p2->getPos()+(m_p2->getRad()/eq_dist)*D;
m_p2->applyForce(m_force,pos);
m_p1->applyForce(-1.0*m_force,pos);
m_cpos=pos;
}
}
/*!
get the potential energy stored in the interaction
*/
double CElasticInteraction::getPotentialEnergy() const
{
double e_pot_norm=0.5*m_force*m_force/m_k;
return e_pot_norm;
}
Vec3 CElasticInteraction::getForce() const
{
return m_force;
}
/*!
Get the particle member function which returns a scalar field of a given name.
\param name the name of the field
*/
CElasticInteraction::ScalarFieldFunction CElasticInteraction::getScalarFieldFunction(const string& name)
{
CElasticInteraction::ScalarFieldFunction sf;
if (name=="potential_energy")
{
sf=&CElasticInteraction::getPotentialEnergy;
}
else if (name=="count")
{
sf=&CElasticInteraction::Count;
}
else
{
sf=NULL;
cerr << "ERROR - invalid name for interaction scalar access function" << endl;
}
return sf;
}
/*!
Get the particle member function which returns a checked scalar field of a given name.
\param name the name of the field
*/
CElasticInteraction::CheckedScalarFieldFunction CElasticInteraction::getCheckedScalarFieldFunction(const string& name)
{
CElasticInteraction::CheckedScalarFieldFunction sf;
sf=NULL;
cerr << "ERROR - invalid name for interaction scalar access function" << endl;
return sf;
}
/*!
Get the particle member function which returns a vector field of a given name.
\param name the name of the field
*/
CElasticInteraction::VectorFieldFunction CElasticInteraction::getVectorFieldFunction(const string& name)
{
CElasticInteraction::VectorFieldFunction vf;
if (name=="force"){
vf=&CElasticInteraction::getForce;
} else {
vf=NULL;
cerr << "ERROR - invalid name for interaction vector access function" << endl;
}
return vf;
}
/*!
save restart data to ostream
\param oStream the output stream
*/
void CElasticInteraction::saveRestartData(std::ostream &oStream)
{
oStream << m_id[0] << " ";
oStream << m_id[1] << " ";
oStream << m_init << " ";
oStream << m_k << " ";
oStream << m_scaling;
}
/*!
load restart data from stream
\param iStream the input stream
*/
void CElasticInteraction::loadRestartData(std::istream &iStream)
{
iStream >> m_id[0];
iStream >> m_id[1];
iStream >> m_init ;
iStream >> m_k;
iStream >> m_scaling;
}
ostream& operator<<(ostream& ost,const CElasticInteraction& BI)
{
ost << "[" << BI.m_p1->getID() << " - " << BI.m_p2->getID() << "]";
return ost;
}
|