#include <coverage_3d_planning/TSPSearch.h>
#include <ros/ros.h>
#include <visualization_msgs/Marker.h>
#include <sys/syscall.h>
#include <sys/sysctl.h>
#include <cmath>
#include <limits>
#include <vector>
#include <algorithm>
#include <ostream>
#include <fstream>
#include <Eigen/Core>