From 5340707b87937d62c6d72197cf494d67851d05e3 Mon Sep 17 00:00:00 2001
From: abel <abel.tim.t@gmail.com>
Date: Tue, 8 Oct 2024 17:41:29 +0200
Subject: UPDATE FOLDER STUCTURE

MOET APARTE_PCB NOG VERWIJDERTEN WINDOWS HEEFT BEST VERGRENDELD
---
 CODE/debug/IMU_comp/calcoffset/calcoffset.ino | 27 +++++++++++++++++++++++++++
 1 file changed, 27 insertions(+)
 create mode 100644 CODE/debug/IMU_comp/calcoffset/calcoffset.ino

(limited to 'CODE/debug/IMU_comp/calcoffset/calcoffset.ino')

diff --git a/CODE/debug/IMU_comp/calcoffset/calcoffset.ino b/CODE/debug/IMU_comp/calcoffset/calcoffset.ino
new file mode 100644
index 0000000..fc5f752
--- /dev/null
+++ b/CODE/debug/IMU_comp/calcoffset/calcoffset.ino
@@ -0,0 +1,27 @@
+void setup() {
+  randomSeed(analogRead(0));
+  Serial.begin(9600);
+
+}
+
+void loop() {
+  int front = random(0, 360);
+  int heading = random(0, 360);
+  Serial.print("Front: ");
+  Serial.println(front);
+  Serial.print("heading: ");
+  Serial.println(heading);
+
+  int offset = heading - front;
+  if(offset<0){
+    offset=(offset+360);
+  }
+  Serial.print("offset: ");
+  Serial.println(offset);
+  
+  Serial.println();
+  Serial.println();
+
+  delay(5000);
+
+}
-- 
cgit v1.2.3