diff --git a/launch/kimera_vio_ros.launch b/launch/kimera_vio_ros.launch index 2104f23..88820cc 100644 --- a/launch/kimera_vio_ros.launch +++ b/launch/kimera_vio_ros.launch @@ -110,8 +110,6 @@ file and include this one to launch KimeraVIO on the dataset of your choice --> - diff --git a/src/KimeraVioRos.cpp b/src/KimeraVioRos.cpp index e904181..c8df673 100644 --- a/src/KimeraVioRos.cpp +++ b/src/KimeraVioRos.cpp @@ -49,6 +49,10 @@ KimeraVioRos::KimeraVioRos() "restart_kimera_vio", &KimeraVioRos::restartKimeraVio, this); CHECK(nh_private_.getParam("use_rviz", use_rviz_)); + // Check that visualization flags are consistent + CHECK_EQ(use_rviz_, FLAGS_visualize) + << "visualize flags must match: use_rviz_ and FLAGS_visualize should " + "be the same"; nh_private_.getParam("use_lcd_registration_server", use_lcd_registration_server_); @@ -304,7 +308,8 @@ void KimeraVioRos::connectVIO() { std::placeholders::_1)); if (vio_params_->frontend_type_ == VIO::FrontendType::kStereoImu) { - auto stereo_pipeline = dynamic_cast(vio_pipeline_.get()); + auto stereo_pipeline = + dynamic_cast(vio_pipeline_.get()); CHECK(stereo_pipeline); data_provider_->registerRightFrameCallback(