inline std::vector<int64_t> LocationToGridIndex(const double x, const double y, const double z) const { return distance_field_.LocationToGridIndex(x, y, z); }
inline std::vector<int64_t> LocationToGridIndex(const Eigen::Vector3d& location) const { return distance_field_.LocationToGridIndex(location); }