refactor: reorganize & add debugging

1 files changed, 37 insertions, 0 deletions

diff --git a/src/utils/time.cpp b/src/utils/time.cpp
new file mode 100644
index 0000000..adc33db
--- /dev/null
+++ b/src/utils/time.cpp
@@ -0,0 +1,37 @@
+#include "time.hpp"
+#include "Arduino.h"
+
+Time::Time(unsigned long time_micros)
+{
+	_time_micros = time_micros;
+}
+
+void Time::update()
+{
+	_time_micros = micros();
+}
+
+Time Time::diff(Time prev_time)
+{
+	return Time(_time_micros - prev_time.microsecs());
+}
+
+unsigned long Time::microsecs()
+{
+	return _time_micros;
+}
+
+unsigned long Time::millisecs()
+{
+	return _time_micros * 0.001;
+}
+
+float Time::secs()
+{
+	return _time_micros * 0.000001;
+}
+
+Time time_now()
+{
+	return Time(micros());
+}