Go to the documentation of this file.
23 using namespace std::placeholders;
25 using namespace gtsam;
38 TEST(ImuBias, Constructor) {
50 TEST(ImuBias, operatorSub) {
57 TEST(ImuBias, operatorAdd) {
64 TEST(ImuBias, operatorSubB) {
76 std::placeholders::_2,
nullptr,
nullptr);
88 std::placeholders::_2,
nullptr,
nullptr);
static int runAllTests(TestResult &result)
Vector biasGyro1(Vector3(0.1, -0.3, -0.2))
Vector biasAcc2(Vector3(0.1, 0.2, 0.04))
#define EXPECT(condition)
internal::FixedSizeMatrix< Y, X2 >::type numericalDerivative22(std::function< Y(const X1 &, const X2 &)> h, const X1 &x1, const X2 &x2, double delta=1e-5)
Vector3 correctAccelerometer(const Vector3 &measurement, OptionalJacobian< 3, 6 > H1={}, OptionalJacobian< 3, 3 > H2={}) const
Bias bias2(biasAcc2, biasGyro2)
Bias bias1(biasAcc1, biasGyro1)
Vector biasAcc1(Vector3(0.2, -0.1, 0))
Some functions to compute numerical derivatives.
TEST(ImuBias, Constructor)
Point2(* f)(const Point3 &, OptionalJacobian< 2, 3 >)
imuBias::ConstantBias Bias
internal::FixedSizeMatrix< Y, X1 >::type numericalDerivative21(const std::function< Y(const X1 &, const X2 &)> &h, const X1 &x1, const X2 &x2, double delta=1e-5)
Vector biasGyro2(Vector3(-0.002, 0.005, 0.03))
bool assert_equal(const Matrix &expected, const Matrix &actual, double tol)
Vector3 correctGyroscope(const Vector3 &measurement, OptionalJacobian< 3, 6 > H1={}, OptionalJacobian< 3, 3 > H2={}) const
static Point2 measurement(323.0, 240.0)
gtsam
Author(s):
autogenerated on Sun Dec 22 2024 04:16:29