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

Added Path 1

Browse Source
This commit is contained in:
Markus Bullmann
2019-06-11 17:28:33 +02:00
parent c973909580
commit 2aa7d682b3
8 changed files with 95561 additions and 53 deletions
Download Patch File Download Diff File Expand all files Collapse all files

19
code/main.cpp
View File

@@ -41,8 +41,7 @@ static Stats::Statistics<float> run(Settings::DataSetup setup, int numFile, std:
Offline::FileReader fr(setup.training[numFile]);
// ground truth
std::vector<int> gtPath;
for(int i = 0; i < setup.numGTPoints; ++i){gtPath.push_back(i);}
std::vector<int> gtPath = setup.gtPath;
Interpolator<uint64_t, Point3> gtInterpolator = fr.getGroundTruthPath(map, gtPath);
Stats::Statistics<float> errorStats;
@@ -70,10 +69,10 @@ static Stats::Statistics<float> run(Settings::DataSetup setup, int numFile, std:
// wifi
auto kalmanMap = std::make_shared<std::unordered_map<MACAddress, Kalman>>();
kalmanMap->insert({ Settings::NUC1, Kalman(1, 6.156) });
kalmanMap->insert({ Settings::NUC2, Kalman(2, 5.650) });
kalmanMap->insert({ Settings::NUC3, Kalman(3, 6.107) });
kalmanMap->insert({ Settings::NUC4, Kalman(4, 3.985) });
kalmanMap->insert({ Settings::NUC1, Kalman(1, setup.NUCs.at(Settings::NUC1).kalman_measStdDev) });
kalmanMap->insert({ Settings::NUC2, Kalman(2, setup.NUCs.at(Settings::NUC2).kalman_measStdDev) });
kalmanMap->insert({ Settings::NUC3, Kalman(3, setup.NUCs.at(Settings::NUC3).kalman_measStdDev) });
kalmanMap->insert({ Settings::NUC4, Kalman(4, setup.NUCs.at(Settings::NUC4).kalman_measStdDev) });
// mesh
@@ -144,7 +143,7 @@ static Stats::Statistics<float> run(Settings::DataSetup setup, int numFile, std:
if (e.type == Offline::Sensor::WIFI_FTM) {
auto ftm = fr.getWifiFtm()[e.idx].data;
float ftm_offset = Settings::NUCS.at(ftm.getAP().getMAC()).ftm_offset;
float ftm_offset = Settings::data.CurrentPath.NUCs.at(ftm.getAP().getMAC()).ftm_offset;
float ftmDist = ftm.getFtmDist() + ftm_offset; // in m; plus static offset
auto& kalman = kalmanMap->at(ftm.getAP().getMAC());
@@ -204,11 +203,11 @@ static Stats::Statistics<float> run(Settings::DataSetup setup, int numFile, std:
// draw wifi ranges
for (auto& ftm : obs.wifi)
{
int nucid = Settings::NUCS.at(ftm.second.getAP().getMAC()).ID;
int nucid = Settings::data.CurrentPath.NUCs.at(ftm.second.getAP().getMAC()).ID;
if (nucid == 1)
{
Point3 apPos = Settings::data.Path0.APs.find(ftm.first)->second;
Point3 apPos = Settings::data.CurrentPath.NUCs.find(ftm.first)->second.position;
//plot.addCircle(nucid, apPos.xy(), ftm.second.getFtmDist());
}
}
@@ -289,7 +288,7 @@ int main(int argc, char** argv)
for(int i = 0; i < 1; ++i){
for(int j = 0; j < 1; ++j){
tmp = run(Settings::data.Path0, j, evaluationName);
tmp = run(Settings::data.CurrentPath, j, evaluationName);
statsMedian.add(tmp.getMedian());
statsAVG.add(tmp.getAvg());
statsSTD.add(tmp.getStdDev());