kindred/solver
1
0
Fork 0
Code Issues 10 Pull Requests 1 Actions Packages Projects Releases Wiki Activity

MbDCode repo renamed to OndselSolver. Several *.asmt files working.

Browse Source
This commit is contained in:
Aik-Siong Koh
2023-08-07 08:21:33 -06:00
parent 6ef4789eca
commit e58446b9e2
287 changed files with 13387 additions and 778 deletions
Download Patch File Download Diff File Expand all files Collapse all files

77
MbDCode/ASMTSpatialContainer.cpp
View File

@@ -326,23 +326,62 @@ void MbD::ASMTSpatialContainer::compareResults(AnalysisType type)
auto accelerationTol = mbdUnts->acceleration * factor;
auto alphaTol = mbdUnts->alpha * factor;
auto i = xs->size() - 1;
assert(Numeric::equaltol(xs->at(i), inxs->at(i), lengthTol));
assert(Numeric::equaltol(ys->at(i), inys->at(i), lengthTol));
assert(Numeric::equaltol(zs->at(i), inzs->at(i), lengthTol));
assert(Numeric::equaltol(bryxs->at(i), inbryxs->at(i), lengthTol));
assert(Numeric::equaltol(bryys->at(i), inbryys->at(i), lengthTol));
assert(Numeric::equaltol(bryzs->at(i), inbryzs->at(i), lengthTol));
assert(Numeric::equaltol(vxs->at(i), invxs->at(i), lengthTol));
assert(Numeric::equaltol(vys->at(i), invys->at(i), lengthTol));
assert(Numeric::equaltol(vzs->at(i), invzs->at(i), lengthTol));
assert(Numeric::equaltol(omexs->at(i), inomexs->at(i), lengthTol));
assert(Numeric::equaltol(omeys->at(i), inomeys->at(i), lengthTol));
assert(Numeric::equaltol(omezs->at(i), inomezs->at(i), lengthTol));
if (type == INPUT) return;
assert(Numeric::equaltol(axs->at(i), inaxs->at(i), lengthTol));
assert(Numeric::equaltol(ays->at(i), inays->at(i), lengthTol));
assert(Numeric::equaltol(azs->at(i), inazs->at(i), lengthTol));
assert(Numeric::equaltol(alpxs->at(i), inalpxs->at(i), lengthTol));
assert(Numeric::equaltol(alpys->at(i), inalpys->at(i), lengthTol));
assert(Numeric::equaltol(alpzs->at(i), inalpzs->at(i), lengthTol));
//Pos
if (!Numeric::equaltol(xs->at(i), inxs->at(i), lengthTol)) {
std::cout << i << " xs " << xs->at(i) << ", " << i<< lengthTol << std::endl;
std::cout << i << " xs " << xs->at(i) << ", " << inxs->at(i) << ", " << lengthTol << std::endl;
}
if (!Numeric::equaltol(ys->at(i), inys->at(i), lengthTol)) {
std::cout << i << " ys " << ys->at(i) << ", " << inys->at(i) << ", " << lengthTol << std::endl;
}
if (!Numeric::equaltol(zs->at(i), inzs->at(i), lengthTol)) {
std::cout << i << " zs " << zs->at(i) << ", " << inzs->at(i) << ", " << lengthTol << std::endl;
}
if (!Numeric::equaltol(bryxs->at(i), inbryxs->at(i), angleTol)) {
std::cout << i << " bryxs " << bryxs->at(i) << ", " << inbryxs->at(i) << ", " << angleTol << std::endl;
}
if (!Numeric::equaltol(bryys->at(i), inbryys->at(i), angleTol)) {
std::cout << i << " bryys " << bryys->at(i) << ", " << inbryys->at(i) << ", " << angleTol << std::endl;
}
if (!Numeric::equaltol(bryzs->at(i), inbryzs->at(i), angleTol)) {
std::cout << i << " bryzs " << bryzs->at(i) << ", " << inbryzs->at(i) << ", " << angleTol << std::endl;
}
//Vel
if (!Numeric::equaltol(vxs->at(i), invxs->at(i), velocityTol)) {
std::cout << i << " vxs " << vxs->at(i) << ", " << invxs->at(i) << ", " << velocityTol << std::endl;
}
if (!Numeric::equaltol(vys->at(i), invys->at(i), velocityTol)) {
std::cout << i << " vys " << vys->at(i) << ", " << invys->at(i) << ", " << velocityTol << std::endl;
}
if (!Numeric::equaltol(vzs->at(i), invzs->at(i), velocityTol)) {
std::cout << i << " vzs " << vzs->at(i) << ", " << invzs->at(i) << ", " << velocityTol << std::endl;
}
if (!Numeric::equaltol(omexs->at(i), inomexs->at(i), omegaTol)) {
std::cout << i << " omexs " << omexs->at(i) << ", " << inomexs->at(i) << ", " << omegaTol << std::endl;
}
if (!Numeric::equaltol(omeys->at(i), inomeys->at(i), omegaTol)) {
std::cout << i << " omeys " << omeys->at(i) << ", " << inomeys->at(i) << ", " << omegaTol << std::endl;
}
if (!Numeric::equaltol(omezs->at(i), inomezs->at(i), omegaTol)) {
std::cout << i << " omezs " << omezs->at(i) << ", " << inomezs->at(i) << ", " << omegaTol << std::endl;
}
//Acc
if (!Numeric::equaltol(axs->at(i), inaxs->at(i), accelerationTol)) {
std::cout << i << " axs " << axs->at(i) << ", " << inaxs->at(i) << ", " << accelerationTol << std::endl;
}
if (!Numeric::equaltol(ays->at(i), inays->at(i), accelerationTol)) {
std::cout << i << " ays " << ays->at(i) << ", " << inays->at(i) << ", " << accelerationTol << std::endl;
}
if (!Numeric::equaltol(azs->at(i), inazs->at(i), accelerationTol)) {
std::cout << i << " azs " << azs->at(i) << ", " << inazs->at(i) << ", " << accelerationTol << std::endl;
}
if (!Numeric::equaltol(alpxs->at(i), inalpxs->at(i), alphaTol)) {
std::cout << i << " alpxs " << alpxs->at(i) << ", " << inalpxs->at(i) << ", " << alphaTol << std::endl;
}
if (!Numeric::equaltol(alpys->at(i), inalpys->at(i), alphaTol)) {
std::cout << i << " alpys " << alpys->at(i) << ", " << inalpys->at(i) << ", " << alphaTol << std::endl;
}
if (!Numeric::equaltol(alpzs->at(i), inalpzs->at(i), alphaTol)) {
std::cout << i << " alpzs " << alpzs->at(i) << ", " << inalpzs->at(i) << ", " << alphaTol << std::endl;
}
}