#include <geometry_msgs/Pose.h>
#include <mrpt/obs/CObservationBeaconRanges.h>
#include <mrpt/ros1bridge/pose.h>
#include <mrpt/ros1bridge/time.h>
#include <mrpt_msgs/ObservationRangeBeacon.h>
#include <mrpt_msgs_bridge/beacon.h>
#include "tf2/LinearMath/Matrix3x3.h"
#include "tf2/transform_datatypes.h"