eval final version jopooooooooo

This commit is contained in:
toni
2017-05-03 16:47:21 +02:00
parent ef74eafb60
commit b4720ae288
5 changed files with 129 additions and 76 deletions

View File

@@ -175,13 +175,13 @@ struct PFTransSimple : public K::ParticleFilterTransition<MyState, MyControl>{
p.state.position = newPosition;
}else{
//no new position!
#pragma omp atomic
noNewPositionCounter++;
//#pragma omp atomic
//noNewPositionCounter++;
}
}
std::cout << noNewPositionCounter << std::endl;
//std::cout << noNewPositionCounter << std::endl;
}
};
@@ -323,8 +323,8 @@ struct PFEval : public K::ParticleFilterEvaluation<MyState, MyObs> {
// Point3 posOld_m = p.state.positionOld.inMeter();
const double pWifi = getWIFI(observation, wifiObs, p.state.position);
const double pBaroPressure = getStairProb(p, observation.activity);
//const double pBaroPressure = getBaroPressure(observation, p.state.relativePressure);
//const double pBaroPressure = getStairProb(p, observation.activity);
const double pBaroPressure = getBaroPressure(observation, p.state.relativePressure);
//const double pBeacon = getBEACON(observation, p.state.position);
//small checks