Improve timer efficiency

applications/gui2/src/main.cpp

@@ -155,6 +155,9 @@ int main(int argc, char **argv) {
 	Pylon::PylonAutoInitTerm autoInitTerm;
 	#endif
 
+	// Note: This causes 100% CPU use but prevents the random frame drops.
+	ftl::timer::setHighPrecision(true);
+
 	{
 		nanogui::init();
 		

components/common/cpp/src/timer.cpp

@@ -89,6 +89,30 @@ static void waitTimePoint() {
 		}
 	}
 
+	/*while (msdelay >= 10 && sincelast != mspf) {
+		sleep_for(milliseconds(5));
+		now = get_time();
+		msdelay = mspf - (now % mspf);
+	}*/
+
+	if (msdelay >= 2 && sincelast != mspf) {
+		UNIQUE_LOCK(mtx, lk);
+		auto idle_job = jobs[kTimerIdle1].begin();
+		while (idle_job != jobs[kTimerIdle1].end() && msdelay >= 2 && sincelast != mspf) {
+			(*idle_job).active = true;
+			bool doremove = !(*idle_job).job.trigger(now);
+
+			if (doremove) {
+				idle_job = jobs[kTimerIdle1].erase(idle_job);
+				LOG(INFO) << "Timer job removed";
+			} else {
+				(*idle_job++).active = false;
+			}
+			now = get_time();
+			msdelay = mspf - (now % mspf);
+		}
+	}
+
 	if (hprec_) {
 		// Spin loop until exact grab time
 		// Accurate to around 4 micro seconds.
@@ -194,6 +218,13 @@ static void trigger_jobs() {
 
 		auto *pj = &j;
 
+		// If last job in list then do in this thread
+		if (active_jobs == jobs[kTimerMain].size()+1) {
+			bool doremove = !pj->job.trigger(ts);
+			pj->active = false;
+			active_jobs--;
+			if (doremove) removeJob(pj->id);
+		} else {
 			ftl::pool.push([pj,ts](int id) {
 				bool doremove = !pj->job.trigger(ts);
 				pj->active = false;
@@ -201,6 +232,7 @@ static void trigger_jobs() {
 				if (doremove) removeJob(pj->id);
 			});
 		}
+	}
 
 	// Final cleanup of stale jobs
 	for (size_t j=0; j<kTimerMAXLEVEL; ++j) {

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

@@ -92,7 +92,7 @@ class Source : public ftl::Configurable, public ftl::data::DiscreteSource {
 	BaseSourceImpl *impl_;
 	SHARED_MUTEX mutex_;
 	cudaStream_t stream_;
-	bool is_retrieving;
+	std::atomic_bool is_retrieving;
 
 	void _swap();
 };

components/streams/src/builder.cpp

@@ -138,7 +138,7 @@ void IntervalSourceBuilder::start() {
 		// TODO: Do in parallel...
 		for (auto *s : srcs_) {
 			if (!s->retrieve(fs->firstFrame())) {
-				LOG(WARNING) << "Frame was skipping";
+				LOG(WARNING) << "Frame is being skipped: " << ts;
 			}
 		}