tami/MYNT-EYE-S-SDK
6
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

change function name

Browse Source
This commit is contained in:
KalmanSLightech 2018-07-03 18:06:24 +08:00
parent becccd9b8f
commit c5b054c864
1 changed files with 4 additions and 16 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

20
wrappers/ros/src/mynt_eye_ros_wrapper/src/wrapper_nodelet.cc
View File

@ -44,7 +44,7 @@ MYNTEYE_BEGIN_NAMESPACE
namespace enc = sensor_msgs::image_encodings; namespace enc = sensor_msgs::image_encodings;
ros::Time HardTime2SoftTime(double _hard_time) { ros::Time hardTimeToSoftTime(double _hard_time) {
static bool isInited = false; static bool isInited = false;
static double soft_time_begin(0), hard_time_begin(0); static double soft_time_begin(0), hard_time_begin(0);
@ -255,11 +255,7 @@ class ROSWrapperNodelet : public nodelet::Nodelet {
void publishTopics() { void publishTopics() {
api_->SetStreamCallback( api_->SetStreamCallback(
Stream::LEFT, [this](const api::StreamData &data) { Stream::LEFT, [this](const api::StreamData &data) {
ros::Time stamp = HardTime2SoftTime(data.img->timestamp); ros::Time stamp = hardTimeToSoftTime(data.img->timestamp);
// static double ros_time_beg = ros::Time::now().toSec();
// static double img_time_beg = data.img->timestamp;
// ros::Time stamp(
// ros_time_beg + (data.img->timestamp - img_time_beg) * 0.00001f);
// static double img_time_prev = -1; // static double img_time_prev = -1;
// NODELET_INFO_STREAM("ros_time_beg: " << FULL_PRECISION << // NODELET_INFO_STREAM("ros_time_beg: " << FULL_PRECISION <<
@ -282,11 +278,7 @@ class ROSWrapperNodelet : public nodelet::Nodelet {
api_->SetStreamCallback( api_->SetStreamCallback(
Stream::RIGHT, [this](const api::StreamData &data) { Stream::RIGHT, [this](const api::StreamData &data) {
ros::Time stamp = HardTime2SoftTime(data.img->timestamp); ros::Time stamp = hardTimeToSoftTime(data.img->timestamp);
// static double ros_time_beg = ros::Time::now().toSec();
// static double img_time_beg = data.img->timestamp;
// ros::Time stamp(
// ros_time_beg + (data.img->timestamp - img_time_beg) * 0.00001f);
++right_count_; ++right_count_;
publishCamera(Stream::RIGHT, data, right_count_, stamp); publishCamera(Stream::RIGHT, data, right_count_, stamp);
@ -318,11 +310,7 @@ class ROSWrapperNodelet : public nodelet::Nodelet {
}); });
api_->SetMotionCallback([this](const api::MotionData &data) { api_->SetMotionCallback([this](const api::MotionData &data) {
ros::Time stamp = HardTime2SoftTime(data.imu->timestamp); ros::Time stamp = hardTimeToSoftTime(data.imu->timestamp);
// static double ros_time_beg = ros::Time::now().toSec();
// static double imu_time_beg = data.imu->timestamp;
// ros::Time stamp(
// ros_time_beg + (data.imu->timestamp - imu_time_beg) * 0.00001f);
// static double imu_time_prev = -1; // static double imu_time_prev = -1;
// NODELET_INFO_STREAM("ros_time_beg: " << FULL_PRECISION << ros_time_beg // NODELET_INFO_STREAM("ros_time_beg: " << FULL_PRECISION << ros_time_beg