Fix imu stamp bug in ros
This commit is contained in:
parent
a9353c965a
commit
5c46c72883
|
@ -99,8 +99,7 @@ int main(int argc, char *argv[]) {
|
|||
return -1;
|
||||
}
|
||||
cv::imshow("frame", img);
|
||||
|
||||
{ // save
|
||||
if (img_count > 10 && imu_count > 50) { // save
|
||||
for (auto &&left : left_datas) {
|
||||
dataset.SaveStreamData(Stream::LEFT, left);
|
||||
}
|
||||
|
|
|
@ -341,9 +341,10 @@ class ROSWrapperNodelet : public nodelet::Nodelet {
|
|||
} else {
|
||||
NODELET_WARN_STREAM("Motion data is empty");
|
||||
}
|
||||
} else {
|
||||
publishImu(data, imu_count_, stamp);
|
||||
publishTemp(data.imu->temperature, imu_count_, stamp);
|
||||
}
|
||||
publishImu(data, imu_count_, stamp);
|
||||
publishTemp(data.imu->temperature, imu_count_, stamp);
|
||||
NODELET_DEBUG_STREAM(
|
||||
"Imu count: " << imu_count_ << ", timestamp: " << data.imu->timestamp
|
||||
<< ", accel_x: " << data.imu->accel[0]
|
||||
|
|
Loading…
Reference in New Issue
Block a user