#include <gtest/gtest.h>#include <cmath>#include <cstddef>#include <tuple>#include <vector>#include <range/v3/algorithm/count_if.hpp>#include <sophus/common.hpp>#include <sophus/se2.hpp>#include "beluga/primitives.hpp"#include "beluga_ros/messages.hpp"#include "beluga_ros/particle_cloud.hpp"