From 038dcfa9891a940240e6731dc4fe17736e3e57b8 Mon Sep 17 00:00:00 2001
From: Hykilpikonna <me@hydev.org>
Date: Tue, 11 Apr 2023 23:39:56 -0400
Subject: [PATCH] [+] fps reporting

---
 firmware/src/main.cpp | 14 ++++++++++++++
 1 file changed, 14 insertions(+)

diff --git a/firmware/src/main.cpp b/firmware/src/main.cpp
index 89ef73e..0b228fa 100644
--- a/firmware/src/main.cpp
+++ b/firmware/src/main.cpp
@@ -90,11 +90,25 @@ void on_sensor_update(int id, u64 time, u32 last, u32 current)
     }
 }
 
+u64 fps_time_counter = 0;
+u32 fps_updates = 0;
+u32 fps_interval_ms = 1000;
+
 void loop()
 {
     u64 time = timeMillis();
     u64 elapsed = time - start_time;
 
+    // Report FPS every second
+    fps_time_counter += elapsed;
+    fps_updates++;
+    if (fps_time_counter >= fps_interval_ms)
+    {
+        fps_time_counter -= fps_interval_ms;
+        double fps = 1.0 * fps_updates / fps_interval_ms * 1000;
+        Serial.printf("FPS: %.2f\r\n", fps);
+    }
+
     // Toggle LED refresh indicator
     digitalWrite(LED_REFRESH, led_refresh_on = !led_refresh_on);
 //    Serial.printf("%" PRIu64 "=============\r\n", elapsed);