48 |
|
#include "applications/hydrodynamics/Ellipsoid.hpp" |
49 |
|
#include "applications/hydrodynamics/CompositeShape.hpp" |
50 |
|
#include "math/LU.hpp" |
51 |
+ |
#include "utils/simError.h" |
52 |
|
namespace oopse { |
53 |
|
/** |
54 |
|
* Reference: |
58 |
|
*/ |
59 |
|
|
60 |
|
ApproximationModel::ApproximationModel(StuntDouble* sd, SimInfo* info): HydrodynamicsModel(sd, info){ |
60 |
– |
/* |
61 |
– |
DynamicProperty::const_iterator iter; |
61 |
|
|
63 |
– |
iter = extraParams.find("Viscosity"); |
64 |
– |
if (iter != extraParams.end()) { |
65 |
– |
boost::any param = iter->second; |
66 |
– |
viscosity = boost::any_cast<double>(param); |
67 |
– |
}else { |
68 |
– |
std::cout << "ApproximationModel Error\n" ; |
69 |
– |
} |
70 |
– |
|
71 |
– |
iter = extraParams.find("Temperature"); |
72 |
– |
if (iter != extraParams.end()) { |
73 |
– |
boost::any param = iter->second; |
74 |
– |
temperature = boost::any_cast<double>(param); |
75 |
– |
}else { |
76 |
– |
std::cout << "ApproximationModel Error\n" ; |
77 |
– |
} |
78 |
– |
*/ |
62 |
|
} |
63 |
|
|
64 |
|
bool ApproximationModel::calcHydroProps(Spheric* spheric, double viscosity, double temperature) { |
72 |
|
return internalCalcHydroProps(static_cast<Shape*>(compositeShape), viscosity, temperature); |
73 |
|
} |
74 |
|
|
75 |
< |
|
93 |
< |
bool ApproximationModel::internalCalcHydroProps(Shape* shape, double viscosity, double temperature) { |
75 |
> |
void ApproximationModel::init() { |
76 |
|
if (!createBeads(beads_)) { |
77 |
< |
std::cout << "can not create beads" << std::endl; |
78 |
< |
return false; |
77 |
> |
sprintf(painCave.errMsg, "ApproximationModel::init() : Can not create beads\n"); |
78 |
> |
painCave.isFatal = 1; |
79 |
> |
simError(); |
80 |
|
} |
81 |
|
|
82 |
+ |
} |
83 |
+ |
|
84 |
+ |
bool ApproximationModel::internalCalcHydroProps(Shape* shape, double viscosity, double temperature) { |
85 |
+ |
|
86 |
|
bool ret = true; |
87 |
|
HydroProps cr; |
88 |
|
HydroProps cd; |
111 |
|
Vector3d Rij = beads[i].pos - beads[j].pos; |
112 |
|
double rij = Rij.length(); |
113 |
|
double rij2 = rij * rij; |
114 |
< |
double sumSigma2OverRij2 = ((beads[i].radius*beads[i].radius) + (beads[i].radius*beads[i].radius)) / rij2; |
114 |
> |
double sumSigma2OverRij2 = ((beads[i].radius*beads[i].radius) + (beads[j].radius*beads[j].radius)) / rij2; |
115 |
|
Mat3x3d tmpMat; |
116 |
|
tmpMat = outProduct(Rij, Rij) / rij2; |
117 |
|
double constant = 8.0 * NumericConstant::PI * viscosity * rij; |
128 |
|
|
129 |
|
//invert B Matrix |
130 |
|
invertMatrix(B, C); |
131 |
< |
|
131 |
> |
|
132 |
|
//prepare U Matrix relative to arbitrary origin O(0.0, 0.0, 0.0) |
133 |
|
std::vector<Mat3x3d> U; |
134 |
|
for (int i = 0; i < nbeads; ++i) { |
274 |
|
Vector3d Rij = beads[i].pos - beads[j].pos; |
275 |
|
double rij = Rij.length(); |
276 |
|
double rij2 = rij * rij; |
277 |
< |
double sumSigma2OverRij2 = ((beads[i].radius*beads[i].radius) + (beads[i].radius*beads[i].radius)) / rij2; |
277 |
> |
double sumSigma2OverRij2 = ((beads[i].radius*beads[i].radius) + (beads[j].radius*beads[j].radius)) / rij2; |
278 |
|
Mat3x3d tmpMat; |
279 |
|
tmpMat = outProduct(Rij, Rij) / rij2; |
280 |
|
double constant = 8.0 * NumericConstant::PI * viscosity * rij; |
447 |
|
|
448 |
|
} |
449 |
|
|
450 |
< |
/* |
450 |
> |
|
451 |
|
void ApproximationModel::writeBeads(std::ostream& os) { |
452 |
|
std::vector<BeadParam>::iterator iter; |
453 |
|
os << beads_.size() << std::endl; |
457 |
|
} |
458 |
|
|
459 |
|
} |
473 |
– |
*/ |
460 |
|
|
461 |
|
|
462 |
+ |
|
463 |
|
} |