#include <gmock/gmock.h>#include <gtest/gtest.h>#include <algorithm>#include <limits>#include <numeric>#include <vector>#include <Eigen/Core>#include <sophus/common.hpp>#include <sophus/se2.hpp>#include <sophus/so2.hpp>#include "beluga/algorithm/estimation.hpp"#include "beluga/testing/sophus_matchers.hpp"