34 #include <gtest/gtest.h> 78 for(
int i = 0; i<(int)20/std::get<0>(GetParam()); ++i)
87 EXPECT_NEAR(expected_dt_us / 1e6f, imu_sample_buffered.
delta_ang_dt, 1e-5
f);
88 EXPECT_NEAR(expected_dt_us / 1e6f, imu_sample_buffered.
delta_vel_dt, 1e-5
f);
104 std::make_tuple<float,float>(1.0
f,1.0
f),
105 std::make_tuple<float,float>(1.6
f,1.6
f),
106 std::make_tuple<float,float>(0.333
f,1.0
f)
void setIMUData(const imuSample &imu_sample)
Vector3f delta_ang
delta angle in body frame (integrated gyro measurements) (rad)
uint64_t time_us
timestamp of the measurement (uSec)
Vector< float, 6 > f(float t, const Matrix< float, 6, 1 > &, const Matrix< float, 3, 1 > &)
imuSample get_imu_sample_delayed()
Vector3< float > Vector3f
static constexpr unsigned FILTER_UPDATE_PERIOD_MS
INSTANTIATE_TEST_CASE_P(imuSamplingAtMultipleRates, EkfImuSamplingTestParametrized, ::testing::Values(std::make_tuple< float, float >(1.0f, 1.0f), std::make_tuple< float, float >(1.6f, 1.6f), std::make_tuple< float, float >(0.333f, 1.0f)))
TEST_P(EkfImuSamplingTestParametrized, imuSamplingAtMultipleRates)
bool init(uint64_t timestamp) override
Vector3f delta_vel
delta velocity in body frame (integrated accelerometer measurements) (m/sec)
float delta_ang_dt
delta angle integration period (sec)
Class for core functions for ekf attitude and position estimator.
float delta_vel_dt
delta velocity integration period (sec)