Fix timestamp to grab frame

components/rgbd-sources/include/ftl/rgbd/source.hpp

@@ -118,7 +118,7 @@ class Source : public ftl::Configurable {
 	void writeFrames(const ftl::cuda::TextureObject<uchar4> &rgb, const ftl::cuda::TextureObject<uint> &depth, cudaStream_t stream);
 	void writeFrames(const ftl::cuda::TextureObject<uchar4> &rgb, const ftl::cuda::TextureObject<float> &depth, cudaStream_t stream);
 
-	int64_t timestamp() const { return (impl_) ? impl_->timestamp_ : 0; }
+	int64_t timestamp() const { return timestamp_; }
 
 	/**
 	 * Directly upload source RGB and Depth to GPU.
@@ -204,6 +204,7 @@ class Source : public ftl::Configurable {
 	bool bullet_;
 	channel_t channel_;
 	cudaStream_t stream_;
+	int64_t timestamp_;
 
 	detail::Source *_createImplementation();
 	detail::Source *_createFileImpl(const ftl::URI &uri);

components/rgbd-sources/src/source.cpp

@@ -30,6 +30,7 @@ Source::Source(ftl::config::json_t &cfg) : Configurable(cfg), pose_(Eigen::Matri
 	impl_ = nullptr;
 	params_ = {0};
 	stream_ = 0;
+	timestamp_ = 0;
 	reset();
 
 	on("uri", [this](const ftl::config::Event &e) {
@@ -42,6 +43,7 @@ Source::Source(ftl::config::json_t &cfg, ftl::net::Universe *net) : Configurable
 	impl_ = nullptr;
 	params_ = {0};
 	stream_ = 0;
+	timestamp_ = 0;
 	reset();
 
 	on("uri", [this](const ftl::config::Event &e) {
@@ -228,6 +230,7 @@ bool Source::grab() {
 		stream_ = 0;
 		return true;
 	} else if (impl_ && impl_->grab(-1,-1)) {
+		timestamp_ = impl_->timestamp_;
 		impl_->rgb_.copyTo(rgb_);
 		impl_->depth_.copyTo(depth_);
 		return true;