From 5b876677d641148cf8f1f040e607465f3635941c Mon Sep 17 00:00:00 2001
From: Matthew Kennedy <matthewkennedy@outlook.com>
Date: Sun, 24 Nov 2024 02:19:02 -0500
Subject: [PATCH] more accurate SD card rate

---
 firmware/hw_layer/mmc_card.cpp | 5 +++--
 1 file changed, 3 insertions(+), 2 deletions(-)

diff --git a/firmware/hw_layer/mmc_card.cpp b/firmware/hw_layer/mmc_card.cpp
index a956e13b80..7206a3ba0b 100644
--- a/firmware/hw_layer/mmc_card.cpp
+++ b/firmware/hw_layer/mmc_card.cpp
@@ -566,6 +566,7 @@ void mlgLogger() {
 		}
 #endif
 
+		systime_t before = chVTGetSystemTime();
 
 		writeSdLogLine(logBuffer);
 
@@ -581,8 +582,8 @@ void mlgLogger() {
 			freq = 1;
 		}
 
-		auto period = 1e6 / freq;
-		chThdSleepMicroseconds((int)period);
+		systime_t period = CH_CFG_ST_FREQUENCY / freq;
+		chThdSleepUntilWindowed(before, before + period);
 	}
 }