Formula Student Autonomous Systems
The code for the main driverless system
Loading...
Searching...
No Matches
consecutive_counter_filter.hpp
Go to the documentation of this file.
1#include <set>
2
4#define EQUALITY_TOLERANCE 1e-3
5
7private:
8 Eigen::VectorXd map;
9 Eigen::VectorXi counter;
10
11public:
13 std::shared_ptr<DataAssociationModel> data_association)
14 : LandmarkFilter(params, data_association), map(Eigen::VectorXd::Zero(0)) {}
15
29 Eigen::VectorXd filter(const Eigen::VectorXd& observations,
30 const Eigen::VectorXd& observation_confidences,
31 Eigen::VectorXi& associations) override;
32
33 void delete_landmarks(const Eigen::VectorXd& some_landmarks) override;
35};
void delete_landmarks(const Eigen::VectorXd &some_landmarks) override
Used by SLAM to signal to the filter that the landmarks are already in SLAM's map,...
ConsecutiveCounterFilter(LandmarkFilterParameters params, std::shared_ptr< DataAssociationModel > data_association)
Eigen::VectorXd filter(const Eigen::VectorXd &observations, const Eigen::VectorXd &observation_confidences, Eigen::VectorXi &associations) override
This function receives a new set of observations and returns a filtered set of landmarks in global co...
This class is meant to filter observations from perception to try to reduce the presence of outliers.