Diff: main.cpp

Revision:

4:577548612451

Parent:

3:caca5cdad681

--- a/main.cpp	Wed Mar 24 19:35:54 2021 +0000
+++ b/main.cpp	Thu Mar 25 13:08:23 2021 +0000
@@ -12,7 +12,7 @@
 #include "bmm150_defs.h"
 #include <math.h>
 #define PI  3.141592653589793238462643383279L
-#define PI2 6.283185307179586476925286766559L
+#define DPI 6.283185307179586476925286766559L
 
 
 Serial pc(SERIAL_TX, SERIAL_RX);
@@ -23,10 +23,10 @@
 
     if (bmm.initialize() == BMM150_E_ID_NOT_CONFORM) 
     {
-        pc.printf("Chip ID can not be read!\n");
+        pc.printf("Chip ID can not be read, BMM150 not found!\n");
         while (1);      // All is lost
     } else {
-        pc.printf("Initialize done!\n");
+        pc.printf("Initialize done, BMM150 has been founded!\n");
     }
 
 }
@@ -49,18 +49,18 @@
     
         if (heading < 0.0) 
         {
-            heading += PI2;
+            heading += DPI;
         }
-        if (heading > PI2) 
+        if (heading > DPI) 
         {
-            heading -= PI2;
+            heading -= DPI;
         }
         double headingDegrees = heading * 180.0 / PI;
         double xyHeadingDegrees = xyHeading * 180.0 / PI;
         double zxHeadingDegrees = zxHeading * 180.0 / PI;
     
-        pc.printf("Heading: %f deg\n ",headingDegrees);
+        pc.printf("Heading: %3.2f deg\n ",headingDegrees);
 
-        wait_ms(500);
+        wait_ms(1000);
     }
 }
\ No newline at end of file