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
|
/////////////////////////////////////////////////////////////
// //
// 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 "EEdge2DInteraction.h"
#include "Foundation/vec3.h"
// -- STL includes --
#include <utility>
using std::pair;
/*!
default constructor
*/
EEdge2DInteraction::EEdge2DInteraction()
{
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
*/
EEdge2DInteraction::EEdge2DInteraction(CParticle* p,Edge2D* e,ETriMeshIP param ,bool iflag)
{
m_p=p;
m_edge=e;
m_k=param.k;
m_inner_flag=iflag;
}
/*!
destructor
*/
EEdge2DInteraction::~EEdge2DInteraction()
{}
/*!
calculate & apply forces
*/
void EEdge2DInteraction::calcForces()
{
Vec3 ppos=m_p->getPos();
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->getNormal();
Vec3 pos=m_p->getPos()-dist.second*m_edge->getNormal();
m_p->applyForce(force,pos);
}
}
|