Formula Student Autonomous Systems
The code for the main driverless system
Loading...
Searching...
No Matches
odometry_model.hpp
Go to the documentation of this file.
1#pragma once
2
3#pragma once
4
5#include <Eigen/Dense>
6
8
16public:
25 Eigen::Vector3d get_pose_difference(const Eigen::Vector3d &previous_pose,
26 const Eigen::VectorXd &motion_data,
27 const double delta_t) override;
28
36 Eigen::Matrix3d get_jacobian_pose(const Eigen::Vector3d &previous_pose,
37 const Eigen::VectorXd &motion_data,
38 const double delta_t) override;
39
49 Eigen::MatrixXd get_jacobian_motion_data(const Eigen::Vector3d &previous_pose,
50 [[maybe_unused]] const Eigen::VectorXd &motion_data,
51 const double delta_t) override;
52};
Motion model to apply to odometry sources which already output pose.
Eigen::Vector3d get_pose_difference(const Eigen::Vector3d &previous_pose, const Eigen::VectorXd &motion_data, const double delta_t) override
Gives the increments to the pose instead of the next pose.
Eigen::Matrix3d get_jacobian_pose(const Eigen::Vector3d &previous_pose, const Eigen::VectorXd &motion_data, const double delta_t) override
Get the Jacobian matrix of the motion model in relation to motion_data (commands)
Eigen::MatrixXd get_jacobian_motion_data(const Eigen::Vector3d &previous_pose, const Eigen::VectorXd &motion_data, const double delta_t) override
Get the Jacobian matrix of the motion model in relation to motion data (commands)
Base class for the 'vehicle to pose' (more in interal background review) motion models.