Formula Student Autonomous Systems
The code for the main driverless system
Loading...
Searching...
No Matches
loop_closure.hpp
Go to the documentation of this file.
1#pragma once
2
3#include <Eigen/Core>
5#include <utility>
6#include <vector>
7
12public:
18 struct Result {
20 double offset;
21 };
22
23 virtual ~LoopClosure() = default;
24
35 virtual Result detect(const Eigen::Vector3d& current_pose, const Eigen::VectorXd& map_cones,
36 const Eigen::VectorXi& associations,
37 const Eigen::VectorXd& observations) const = 0;
38};
Interface for detecting loop closures.
virtual Result detect(const Eigen::Vector3d &current_pose, const Eigen::VectorXd &map_cones, const Eigen::VectorXi &associations, const Eigen::VectorXd &observations) const =0
Call every time you have new observations.
virtual ~LoopClosure()=default
Result of loop closure detection.