From 0aa830b7816509674f145d4164e398c95bb2999f Mon Sep 17 00:00:00 2001
From: alanbjohnston <alan.b.johnston@gmail.com>
Date: Sun, 23 Aug 2020 18:57:06 -0400
Subject: [PATCH] added dps to Angular Velocity formula

---
 afsk/main.c | 3 ++-
 1 file changed, 2 insertions(+), 1 deletion(-)

diff --git a/afsk/main.c b/afsk/main.c
index 5a08e2d2..86d8b7bc 100644
--- a/afsk/main.c
+++ b/afsk/main.c
@@ -1043,7 +1043,8 @@ int get_tlm_fox() {
   int posXv = 0, negXv = 0, posYv = 0, negYv = 0, posZv = 0, negZv = 0;
   int posXi = 0, negXi = 0, posYi = 0, negYi = 0, posZi = 0, negZi = 0;
   int head_offset = 0; 	
-  int xAngularVelocity = 1000, yAngularVelocity = 2000, zAngularVelocity = 3000; // XAxisAngularVelocity
+// AngularVelocity = 43.3 dps + 1960 
+  int xAngularVelocity = 43.3 * (-10) + 1960, yAngularVelocity = 43.3 * (-6) + 196, zAngularVelocity = 43.3 * (6) + 196; // XAxisAngularVelocity
 	
   short int buffer_test[bufLen];
   int buffSize;