added linux fixes
This commit is contained in:
4
.gitignore
vendored
4
.gitignore
vendored
@@ -4,3 +4,7 @@ output/
|
||||
|
||||
__pycache__/
|
||||
.vscode/
|
||||
|
||||
*.tex.ini
|
||||
*.txt.user*
|
||||
build-*/
|
||||
|
||||
@@ -23,7 +23,8 @@ INCLUDE_DIRECTORIES(
|
||||
../../../
|
||||
../../../../
|
||||
|
||||
../../eigen3
|
||||
../../eigen3
|
||||
/usr/include/eigen3
|
||||
)
|
||||
|
||||
|
||||
|
||||
@@ -2,6 +2,7 @@
|
||||
|
||||
#include <unordered_map>
|
||||
#include <vector>
|
||||
#include <memory>
|
||||
|
||||
#include <Indoor/geo/Point3.h>
|
||||
|
||||
|
||||
@@ -21,7 +21,7 @@ float Kalman::predictAndUpdate(const Timestamp timestamp, const float measurment
|
||||
Eigen::Map<Eigen::Matrix<float, 2, 2>> P(this->P);
|
||||
|
||||
// init kalman filter
|
||||
if (isnan(lastTimestamp))
|
||||
if (std::isnan(lastTimestamp))
|
||||
{
|
||||
P << 10, 0,
|
||||
0, 10; // Initial Uncertainty
|
||||
@@ -30,7 +30,7 @@ float Kalman::predictAndUpdate(const Timestamp timestamp, const float measurment
|
||||
0;
|
||||
}
|
||||
|
||||
const float dt = isnan(lastTimestamp) ? 1 : timestamp.sec() - lastTimestamp;
|
||||
const float dt = std::isnan(lastTimestamp) ? 1 : timestamp.sec() - lastTimestamp;
|
||||
lastTimestamp = timestamp.sec();
|
||||
|
||||
Eigen::Matrix<float, 1, 2> H; // Measurement function
|
||||
@@ -62,7 +62,7 @@ float Kalman::predictAndUpdate(const Timestamp timestamp, const float measurment
|
||||
|
||||
KalmanPrediction Kalman::predict(const Timestamp timestamp)
|
||||
{
|
||||
if (isnan(lastTimestamp))
|
||||
if (std::isnan(lastTimestamp))
|
||||
{
|
||||
// Kalman has no data => nothing to predict
|
||||
return KalmanPrediction{ NAN, NAN };
|
||||
|
||||
@@ -1,7 +1,10 @@
|
||||
#pragma once
|
||||
|
||||
#include <cmath>
|
||||
|
||||
#include <Indoor/data/Timestamp.h>
|
||||
|
||||
|
||||
struct KalmanPrediction
|
||||
{
|
||||
float distance;
|
||||
|
||||
@@ -147,7 +147,7 @@ namespace Plotta
|
||||
template<>
|
||||
inline plottastream& operator<<(plottastream& stream, const float& value)
|
||||
{
|
||||
return stream << (isnan(value) ? "float(\"nan\")" : std::to_string(value));
|
||||
return stream << (std::isnan(value) ? "float(\"nan\")" : std::to_string(value));
|
||||
}
|
||||
|
||||
template<>
|
||||
|
||||
@@ -583,7 +583,7 @@ public:
|
||||
|
||||
#if defined(_WINDOWS)
|
||||
stream << "set terminal windows size 2000,1500\n";
|
||||
#elif
|
||||
#else
|
||||
stream << "set terminal x11 size 2000,1500\n";
|
||||
#endif
|
||||
stream << gp.getBuffer();
|
||||
|
||||
@@ -12,7 +12,7 @@ namespace Settings {
|
||||
const std::string plotDataDir = "../plots/data/";
|
||||
const std::string outputDir = "../output/";
|
||||
|
||||
const bool PlotCircles = false;
|
||||
const bool PlotCircles = true;
|
||||
const bool PlotToPng = false;
|
||||
|
||||
const bool UseKalman = false;
|
||||
|
||||
@@ -620,10 +620,6 @@ static CombinedStats<float> run(Settings::DataSetup setup, int walkIdx, std::str
|
||||
|
||||
errorPlot.frame();
|
||||
|
||||
|
||||
std::cout << "Press any key to continue ..." << std::endl;
|
||||
std::cin.get();
|
||||
|
||||
// MATLAB output
|
||||
//{
|
||||
// std::ofstream matlab_error_out;
|
||||
@@ -736,8 +732,8 @@ int main(int argc, char** argv)
|
||||
//Settings::data.Path9,
|
||||
//Settings::data.Path10,
|
||||
//Settings::data.Path11
|
||||
//Settings::data.Path20,
|
||||
//Settings::data.Path21,
|
||||
Settings::data.Path20,
|
||||
Settings::data.Path21,
|
||||
Settings::data.Path22,
|
||||
};
|
||||
|
||||
|
||||
@@ -192,7 +192,7 @@ static CombinedStats<float> run(Settings::DataSetup setup, int walkIdx, std::str
|
||||
|
||||
|
||||
plot.plot();
|
||||
Sleep(100);
|
||||
std::this_thread::sleep_for(std::chrono::milliseconds(100));
|
||||
}
|
||||
|
||||
obs.clear();
|
||||
|
||||
@@ -69,10 +69,10 @@ struct WifiMeas {
|
||||
int numSucessMeas() const {
|
||||
int count = 0;
|
||||
|
||||
if (!isnan(ftmDists[0])) count++;
|
||||
if (!isnan(ftmDists[1])) count++;
|
||||
if (!isnan(ftmDists[2])) count++;
|
||||
if (!isnan(ftmDists[3])) count++;
|
||||
if (!std::isnan(ftmDists[0])) count++;
|
||||
if (!std::isnan(ftmDists[1])) count++;
|
||||
if (!std::isnan(ftmDists[2])) count++;
|
||||
if (!std::isnan(ftmDists[3])) count++;
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user