UnscentedKalmanFilterTest.cpp File Reference

#include "UnscentedKalmanFilter.h"
#include <cstdlib>
#include <ctime>
#include <ArmarXCore/core/exceptions/local/ExpressionException.h>
#include <ArmarXCore/core/logging/Logging.h>
#include <ArmarXCore/util/time.h>
#include <sciplot/sciplot.hpp>

Include dependency graph for UnscentedKalmanFilterTest.cpp:

Go to the source code of this file.

Typedefs
using	Matrix = Eigen::Matrix< T, 3, 3 >
using	SystemModelT = SystemModelSE3< T >
using	T = float
using	Vector = Eigen::Matrix< T, 3, 1 >

Functions
int	main ()
void	simulate_observation (const std::vector< SystemModelT::StateT > &states, std::vector< SystemModelT::ObsT > &observations)
void	simulate_trajectory (std::vector< SystemModelT::StateT > &states, std::vector< SystemModelT::ControlT > &omegas)
void	test_retract ()
void	test_se3 ()

Variables
constexpr T	acc_noise_std = 0.01
constexpr T	c = (1 / max_time) * 2 * M_PI
constexpr T	dt = max_time / num_timesteps
const Vector	initial_offet_pos = 0.5 * Vector(1, 0.5, 0.7)
constexpr T	initial_offset_angle = 0.0 * 10 * M_PI / 180
constexpr T	max_time = 1
constexpr long	num_timesteps = 3000
constexpr T	obs_noise_std = 0.01
constexpr T	om_noise_std = 0.01

Typedef Documentation

Matrix

using Matrix = Eigen::Matrix<T, 3, 3>

Definition at line 40 of file UnscentedKalmanFilterTest.cpp.

SystemModelT

using SystemModelT = SystemModelSE3<T>

Definition at line 41 of file UnscentedKalmanFilterTest.cpp.

T

using T = float

Definition at line 38 of file UnscentedKalmanFilterTest.cpp.

Vector

using Vector = Eigen::Matrix<T, 3, 1>

Definition at line 39 of file UnscentedKalmanFilterTest.cpp.

Function Documentation

main()

int main

(

)

Definition at line 175 of file UnscentedKalmanFilterTest.cpp.

Here is the call graph for this function:

simulate_observation()

void simulate_observation	(	const std::vector< SystemModelT::StateT > &	states,
		std::vector< SystemModelT::ObsT > &	observations
	)

Definition at line 159 of file UnscentedKalmanFilterTest.cpp.

Here is the call graph for this function:

Here is the caller graph for this function:

simulate_trajectory()

void simulate_trajectory	(	std::vector< SystemModelT::StateT > &	states,
		std::vector< SystemModelT::ControlT > &	omegas
	)

Definition at line 99 of file UnscentedKalmanFilterTest.cpp.

Here is the call graph for this function:

Here is the caller graph for this function:

test_retract()

void test_retract

(

)

Definition at line 55 of file UnscentedKalmanFilterTest.cpp.

Here is the call graph for this function:

Here is the caller graph for this function:

test_se3()

void test_se3

(

)

Definition at line 81 of file UnscentedKalmanFilterTest.cpp.

Here is the call graph for this function:

Variable Documentation

acc_noise_std

constexpr T acc_noise_std = 0.01

constexpr

Definition at line 48 of file UnscentedKalmanFilterTest.cpp.

c

constexpr T c = (1 / max_time) * 2 * M_PI

constexpr

Definition at line 46 of file UnscentedKalmanFilterTest.cpp.

dt

constexpr T dt = max_time / num_timesteps

constexpr

Definition at line 45 of file UnscentedKalmanFilterTest.cpp.

initial_offet_pos

const Vector initial_offet_pos = 0.5 * Vector(1, 0.5, 0.7)

Definition at line 52 of file UnscentedKalmanFilterTest.cpp.

initial_offset_angle

constexpr T initial_offset_angle = 0.0 * 10 * M_PI / 180

constexpr

Definition at line 51 of file UnscentedKalmanFilterTest.cpp.

max_time

constexpr T max_time = 1

constexpr

Definition at line 44 of file UnscentedKalmanFilterTest.cpp.

num_timesteps

constexpr long num_timesteps = 3000

constexpr

Definition at line 43 of file UnscentedKalmanFilterTest.cpp.

obs_noise_std

constexpr T obs_noise_std = 0.01

constexpr

Definition at line 50 of file UnscentedKalmanFilterTest.cpp.

om_noise_std

constexpr T om_noise_std = 0.01

constexpr

Definition at line 49 of file UnscentedKalmanFilterTest.cpp.