This repository has been archived on 2020-04-08. You can view files and clone it, but cannot push or open issues or pull requests.
Files
Indoor/tests/math/TestDistribution.cpp
frank 857d7a1553 fixed some issues
added new pose/turn detections
new helper classes
define-flags for libEigen
2018-09-04 10:49:00 +02:00

207 lines
5.7 KiB
C++

#ifdef WITH_TESTS
#include "../Tests.h"
#include "../../math/distribution/Normal.h"
#include "../../math/distribution/Bessel.h"
#include "../../math/distribution/LUT.h"
#include "../../math/distribution/VonMises.h"
#include "../../math/distribution/Exponential.h"
#include "../../math/distribution/NormalCDF.h"
#include "../../math/distribution/Region.h"
#include "../../math/distribution/Triangle.h"
#include "../../misc/Time.h"
template <typename Dist> void benchDist(Dist dist) {
const int cnt = 1024*1024*32;
float f = 0;
auto tick = Time::tick();
for (int i = 0; i < cnt; ++i) {
f = dist.getProbability(f);
}
auto tock = Time::tick();
std::cout.imbue(std::locale("en_US.UTF-8"));
std::cout << (cnt / (Time::diffMS(tick, tock)+1) * 1000) << "/sec" << std::endl;
}
TEST(Distribution, Exp) {
ASSERT_NEAR(1.5, Distribution::Exponential<float>::getProbability(1.5, 0.0), 0.001);
ASSERT_NEAR(1.0, Distribution::Exponential<float>::getProbability(1.0, 0.0), 0.001);
ASSERT_NEAR(0.5, Distribution::Exponential<float>::getProbability(0.5, 0.0), 0.001);
ASSERT_NEAR(0.35, Distribution::Exponential<float>::getProbability(1.5, 1.0), 0.05);
ASSERT_NEAR(0.35, Distribution::Exponential<float>::getProbability(1.0, 1.0), 0.05);
ASSERT_NEAR(0.35, Distribution::Exponential<float>::getProbability(0.5, 1.0), 0.05);
}
TEST(Distribution, Exp_Performance) {
Distribution::Exponential<float> dist(0.5);
benchDist(dist);
}
TEST(Distribution, BesselHelper) {
Distribution::Bessel<float> bessel;
const float delta = 0.001;
ASSERT_NEAR( 1.0, bessel.getModified(0, 0), delta);
ASSERT_NEAR(11.3, bessel.getModified(0, +4), 0.1);
ASSERT_NEAR(11.3, bessel.getModified(0, -4), 0.1);
}
TEST(Distribution, VonMises) {
Distribution::VonMises<float> dist4(0, 4);
Distribution::VonMises<float> dist2(0, 2);
Distribution::VonMises<float> dist1(0, 1);
Distribution::VonMises<float> dist05(0, 0.5);
const float delta = 0.01;
ASSERT_NEAR(0.768f, dist4.getProbability(0.0f), delta);
ASSERT_NEAR(0.515f, dist2.getProbability(0.0f), delta);
ASSERT_NEAR(0.342f, dist1.getProbability(0.0f), delta);
ASSERT_NEAR(0.24f, dist05.getProbability(0.0f), delta);
}
TEST(Distribution, normalCDF1) {
Distribution::NormalCDF<double> nd(0,1);
ASSERT_NEAR(0.5, nd.getProbability(0), 0.00001);
ASSERT_NEAR(0.5, Distribution::NormalCDF<double>::getProbability(0, 1, 0), 0.00001);
ASSERT_NEAR(1.0, nd.getProbability(5), 0.00001);
ASSERT_NEAR(1.0, Distribution::NormalCDF<double>::getProbability(0, 1, 5), 0.00001);
ASSERT_NEAR(0.0, nd.getProbability(-5), 0.00001);
ASSERT_NEAR(0.0, Distribution::NormalCDF<double>::getProbability(0, 1, -5), 0.00001);
}
TEST(Distribution, normalCDF2) {
Distribution::NormalCDF<double> nd(3,1);
ASSERT_NEAR(0.5, nd.getProbability(3), 0.00001);
ASSERT_NEAR(0.5, Distribution::NormalCDF<double>::getProbability(3, 1, 3), 0.00001);
ASSERT_NEAR(1.0, nd.getProbability(3+5), 0.00001);
ASSERT_NEAR(1.0, Distribution::NormalCDF<double>::getProbability(3, 1, 3+5), 0.00001);
ASSERT_NEAR(0.0, nd.getProbability(3-5), 0.00001);
ASSERT_NEAR(0.0, Distribution::NormalCDF<double>::getProbability(3, 1, 3-5), 0.00001);
}
//#include <fstream>
//TEST(Distribution, VonMisesDump) {
// Distribution::VonMises<float> dist1(0, 4.0);
// auto dist2 = dist1.getLUT();
// std::ofstream f1("/tmp/1.dat");
// std::ofstream f2("/tmp/2.dat");
// for (float i = -4; i <= +4; i += 0.001) {
// f1 << i << " " << dist1.getProbability(i) << std::endl;
// f2 << i << " " << dist2.getProbability(i) << std::endl;
// }
// f1.close();
// f2.close();
//}
TEST(Distribution, VonMises_Performance) {
Distribution::VonMises<float> dist(0, 2.0);
benchDist(dist);
}
TEST(Distribution, VonMisesLUT_Performance) {
Distribution::VonMises<float> src(0, 2.0);
auto dist = src.getLUT();
benchDist(dist);
}
template <typename Dist> float distCheckArea(Dist dist, const float min, const float max) {
float step = 0.05;
float sum = 0;
for (float x = min; x <= max; x += step) {
float val = dist.getProbability(x);
sum += val*step;
}
return sum;
}
#include <fstream>
TEST(Distribution, Region1) {
// std::ofstream out("/tmp/1.dat");
// for (float x = -9; x <= +9; x += 0.025) {
// //const float y = Distribution::Region<float>::getProbability(0, 3, 1.2, x);
// const float y = Distribution::Region<float>::getProbability(1, 2, x);
// out << x << " " << y << "\n";
// }
// out.close();
Distribution::Region<float> dist1(0, 3);
ASSERT_NEAR(1.0, distCheckArea(dist1, -20, +20), 0.01);
Distribution::Region<float> dist2(0, 1);
ASSERT_NEAR(1.0, distCheckArea(dist2, -20, +20), 0.01);
Distribution::Region<float> dist3(1, 3);
ASSERT_NEAR(1.0, distCheckArea(dist3, -20, +20), 0.01);
Distribution::Region<float> dist4(1, 2);
ASSERT_NEAR(1.0, distCheckArea(dist4, -20, +20), 0.01);
Distribution::Region<float> dist5(-1, 4);
ASSERT_NEAR(1.0, distCheckArea(dist5, -20, +20), 0.01);
}
TEST(Distribution, Triangle) {
std::ofstream out("/tmp/1.dat");
for (float x = -9; x <= +9; x += 0.025) {
//const float y = Distribution::Region<float>::getProbability(0, 3, 1.2, x);
const float y = Distribution::Triangle<float>::getProbability(3, 6, x);
out << x << " " << y << "\n";
}
out.close();
Distribution::Triangle<float> dist1(0, 3);
ASSERT_NEAR(1.0, distCheckArea(dist1, -20, +20), 0.01);
Distribution::Triangle<float> dist2(0, 1);
ASSERT_NEAR(1.0, distCheckArea(dist2, -20, +20), 0.01);
Distribution::Triangle<float> dist3(1, 3);
ASSERT_NEAR(1.0, distCheckArea(dist3, -20, +20), 0.01);
Distribution::Triangle<float> dist4(1, 2);
ASSERT_NEAR(1.0, distCheckArea(dist4, -20, +20), 0.01);
Distribution::Triangle<float> dist5(-1, 4);
ASSERT_NEAR(1.0, distCheckArea(dist5, -20, +20), 0.01);
}
#endif