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
|
/////////////////////////////////////////////////////////////
// //
// 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 "ETriangleInteraction.h"
// -- STL includes --
#include <utility>
using std::pair;
/*!
default constructor
*/
ETriangleInteraction::ETriangleInteraction()
{
m_p=NULL;
m_t=NULL;
m_k=0.0;
m_inner_flag=false;
}
/*!
constructor with parameters
\param p
\param t
\param param
\param iflag
*/
ETriangleInteraction::ETriangleInteraction(CParticle* p,Triangle* t,ETriMeshIP param,bool iflag)
{
m_p=p;
m_t=t;
// scale elastic param
double f=1.0;
if(!CParticle::getDo2dCalculations()){
f*=this->m_p->getRad();
}
m_k=f*param.k;
m_inner_flag=iflag;
}
/*!
destructor
*/
ETriangleInteraction::~ETriangleInteraction()
{}
/*!
calculate & apply forces
*/
void ETriangleInteraction::calcForces()
{
pair<bool,double> dist=m_t->dist(m_p->getPos());
if(dist.first && (dist.second<m_p->getRad())){
Vec3 force=m_k*(m_p->getRad()-dist.second)*m_t->getNormal();
Vec3 pos=m_p->getPos()-dist.second*m_t->getNormal();
m_p->applyForce(force,pos);
if(m_inner_flag) m_t->applyForce(-1.0*force);
}
}
|
