From 423af101e26e6d69615db75d9dc8cca504ff932c Mon Sep 17 00:00:00 2001
From: Thefeli73 <thefeli73@hotmail.com>
Date: Wed, 14 Apr 2021 17:38:24 +0200
Subject: [PATCH] add position meter calculation

---
 EENX15_LQR/EENX15_LQR.ino | 1 +
 1 file changed, 1 insertion(+)

diff --git a/EENX15_LQR/EENX15_LQR.ino b/EENX15_LQR/EENX15_LQR.ino
index c8160a8..d04b5fb 100644
--- a/EENX15_LQR/EENX15_LQR.ino
+++ b/EENX15_LQR/EENX15_LQR.ino
@@ -138,6 +138,7 @@ void printInfo(){
   Serial.print("pitch Angle abs = "); Serial.println(abs(safe_angle));
   Serial.print("pitch Angle measured = "); Serial.println(angle_pitch);
   Serial.print("Position: "); Serial.println(countA);
+  Serial.print("Position (m): "); Serial.println(countA/174.76); //r*2pi
   Serial.print("Full Rotations: "); Serial.println(countA/56.0); //ca. 56 tick per rotation
   Serial.print("Rads rotated: "); Serial.println(countA/8.91); //ca. 56 tick per rotation, 6.26 rads per rotation
   Serial.print("RPM: "); Serial.println(rpm); //ca. 56 tick per rotation