Pat McC / BNO055_fusion_AUV
Revision:
7:476e1789d63f
Parent:
6:07d01bf36ad0
Child:
8:909d9978003f
diff -r 07d01bf36ad0 -r 476e1789d63f BNO055.cpp
--- a/BNO055.cpp	Wed Aug 23 09:44:43 2017 +0000
+++ b/BNO055.cpp	Wed Nov 20 16:15:08 2019 +0000
@@ -76,13 +76,13 @@
     p = dt[3] << 8 | dt[2];
     r = dt[5] << 8 | dt[4];
     if (deg_or_rad) {
-        el->h = (double)h / 900;
-        el->p = (double)p / 900;
-        el->r = (double)r / 900;
+        el->h = h;
+        el->p = p;
+        el->r = r;
     } else {
-        el->h = (double)h / 16;
-        el->p = (double)p / 16;
-        el->r = (double)r / 16;
+        el->h = h;
+        el->p = p;
+        el->r = r;
     }
 }