First commit of the code

This commit is contained in:
Ke Sun
2018-01-08 14:41:37 -05:00
parent 37dd131d33
commit 700a3c625a
32 changed files with 5921 additions and 1 deletions

24
src/msckf_vio_nodelet.cpp Normal file
View File

@ -0,0 +1,24 @@
/*
* COPYRIGHT AND PERMISSION NOTICE
* Penn Software MSCKF_VIO
* Copyright (C) 2017 The Trustees of the University of Pennsylvania
* All rights reserved.
*/
#include <msckf_vio/msckf_vio_nodelet.h>
namespace msckf_vio {
void MsckfVioNodelet::onInit() {
msckf_vio_ptr.reset(new MsckfVio(getPrivateNodeHandle()));
if (!msckf_vio_ptr->initialize()) {
ROS_ERROR("Cannot initialize MSCKF VIO...");
return;
}
return;
}
PLUGINLIB_DECLARE_CLASS(msckf_vio, MsckfVioNodelet,
msckf_vio::MsckfVioNodelet, nodelet::Nodelet);
} // end namespace msckf_vio