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
|
/////////////////////////////////////////////////////////////
// //
// 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.opensource.org/licenses/osl-3.0.php //
// //
/////////////////////////////////////////////////////////////
#include "EEdgeInteraction.h"
#include "Foundation/vec3.h"
// -- STL includes --
#include <utility>
using std::pair;
/*!
default constructor
*/
EEdgeInteraction::EEdgeInteraction()
{
m_p=NULL;
m_edge=NULL;
m_k=0.0;
m_inner_flag=false;
}
/*!
constructor with parameters
\param p
\param e
\param param
\param iflag
*/
EEdgeInteraction::EEdgeInteraction(CParticle* p,Edge* e,ETriMeshIP param ,bool iflag)
{
m_p=p;
m_edge=e;
// 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
*/
EEdgeInteraction::~EEdgeInteraction()
{}
/*!
calculate & apply forces
*/
void EEdgeInteraction::calcForces()
{
Vec3 ppos=m_p->getPos();
if(m_edge->isValidContact(ppos)){ // if no contact to adjacent triangles
pair<bool,double> dist=m_edge->dist(ppos);
if(dist.first && (dist.second<m_p->getRad())){
Vec3 force=m_k*(m_p->getRad()-dist.second)*m_edge->getDirectionFromPoint(m_p->getPos());
Vec3 pos=m_p->getPos()-dist.second*m_edge->getDirectionFromPoint(m_p->getPos());
m_p->applyForce(force,pos);
if(m_inner_flag) m_edge->applyForce(-1.0*force);
}
}
}
|