Fix incorrect vision timestamp

components/rgbd-sources/src/sources/stereovideo/stereovideo.cpp

@@ -275,6 +275,7 @@ void StereoVideoSource::updateParameters() {
 }
 
 bool StereoVideoSource::capture(int64_t ts) {
+	capts_ = timestamp_;
 	timestamp_ = ts;
 	lsrc_->grab();
 	return true;
@@ -338,7 +339,7 @@ bool StereoVideoSource::compute(int n, int b) {
 		if (!frame.hasChannel(Channel::Left)) { return false; }
 	}
 
-	host_->notify(timestamp_, frame);
+	host_->notify(capts_, frame);
 	return true;
 }
 

components/rgbd-sources/src/sources/stereovideo/stereovideo.hpp

@@ -38,6 +38,7 @@ class StereoVideoSource : public detail::Source {
 
 	LocalSource *lsrc_;
 	Calibrate *calib_;
+	int64_t capts_;
 
 	cv::Size color_size_;
 	cv::Size depth_size_;