FHWS/FtmPrologic
Archived
4
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Added trilateration code

Browse Source
This commit is contained in:
Markus Bullmann
2019-08-06 11:31:45 +02:00
parent a7571862c6
commit 52eac3a28a
3 changed files with 353 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
code/Plotty.h
View File

@@ -98,6 +98,7 @@ public:
K::GnuplotSplotElementLines pathReal;
K::GnuplotSplotElementLines pathEst;
K::GnuplotSplotElementLines pathEst2;
K::GnuplotSplotElementColorPoints particles;
K::GnuplotSplotElementLines mapOutlineGlass;
@@ -155,6 +156,7 @@ public:
splot.add(&pathReal); pathReal.getStroke().setWidth(2); pathReal.getStroke().getColor().setHexStr("#000000");
splot.add(&pathEst); pathEst.getStroke().setWidth(2); pathEst.getStroke().getColor().setHexStr("#0000ff");
splot.add(&pathEst2); pathEst2.getStroke().setWidth(2); pathEst2.getStroke().getColor().setHexStr("#ff0000");
splot.add(&pm3doutline);
@@ -478,6 +480,11 @@ public:
pathEst.add(est);
}
void addEstimationNode2(const Point3 pos) {
K::GnuplotPoint3 est(pos.x, pos.y, std::round(pos.z * 10) / 10);
pathEst2.add(est);
}
void setTitle(const std::string& title) {
gp << "set title '" << title << "'\n";