2020-10-12 21:09:32 +08:00
|
|
|
#include "oh_my_loam.h"
|
2020-10-16 18:08:31 +08:00
|
|
|
#include "feature_points_extractor/feature_points_extractor_VLP16.h"
|
2020-10-12 21:09:32 +08:00
|
|
|
|
|
|
|
namespace oh_my_loam {
|
|
|
|
|
2020-10-16 18:08:31 +08:00
|
|
|
bool OhMyLoam::Init() {
|
|
|
|
YAML::Node config = Config::Instance()->config();
|
|
|
|
feature_extractor_.reset(new FeaturePointsExtractorVLP16);
|
|
|
|
if (!feature_extractor_->Init(config["feature_extractor_config"])) {
|
|
|
|
AERROR << "Failed to initialize feature points extractor";
|
|
|
|
return false;
|
2020-10-12 21:09:32 +08:00
|
|
|
}
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
|
|
|
void OhMyLoam::Run(const PointCloud& cloud, double timestamp) {
|
2020-10-16 18:08:31 +08:00
|
|
|
FeaturePoints feature_pts;
|
|
|
|
feature_extractor_->Extract(cloud, &feature_pts);
|
2020-10-12 21:09:32 +08:00
|
|
|
}
|
|
|
|
|
2020-10-13 01:07:59 +08:00
|
|
|
} // namespace oh_my_loam
|