FHWS/Fusion2016
Archived
3
0
Fork 0
Code Issues 1 Pull Requests Releases Wiki Activity

added missing code-changes (mainly eval)

Browse Source
This commit is contained in:
FrankE
2016-03-17 17:27:08 +01:00
parent 00d3033eef
commit 4c1e73e3cf
12 changed files with 801 additions and 121 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
code/eval/DebugShortestPath.h
View File

@@ -41,6 +41,9 @@ public:
vis.estPath.clear();
vis.particles.clear();
vis.particles.add(K::GnuplotPoint3(this->centerOfMass.x, this->centerOfMass.y, this->centerOfMass.z));
const int advance = this->stdDevDist / grid.getGridSize_cm();
const T& d = *this->path->getFromStart(advance).element;
vis.particles.add(K::GnuplotPoint3(d.x_cm, d.y_cm, d.z_cm));
for (int i = 0; i < (int)this->path->size()-1; ++i) {
const DijkstraNode<T>& dn1 = (*this->path)[i+0];
const DijkstraNode<T>& dn2 = (*this->path)[i+1];