Team_temp / VT1_domc

Dependencies:   mbed-dev

Fork of Adafruit9-DOf_AHRS_Regler_Discrete by RT-Labor IMS

Revision:
3:bd353b8184cc
Parent:
1:8c4f93e10af3
diff -r 9fd59c70ad78 -r bd353b8184cc Source/main.cpp
--- a/Source/main.cpp	Thu Oct 19 11:52:10 2017 +0000
+++ b/Source/main.cpp	Thu Sep 20 08:35:36 2018 +0000
@@ -41,8 +41,8 @@
 Adafruit_L3GD20_Unified gyro        = Adafruit_L3GD20_Unified(30303);
 
 //Debug/Communication with PC through
-Serial pc(PA_0, PA_1, 115200); //921600; 115200
-Serial serial1(USBTX, USBRX, 9600);
+Serial serial1(PA_0, PA_1, 115200); //921600; 115200
+Serial pc(USBTX, USBRX, 115200);
 
 // Magnetometer correction
 // mounted in gimbal
@@ -131,6 +131,7 @@
     while(1);
 
   }
+   pc.printf("Accel Initialized\r\n");
   if(!mag.begin())
   {
 
@@ -141,6 +142,7 @@
     while(1);
 
   }
+  pc.printf("Mag Initialized\r\n");
   
   gyroRange_t rng = GYRO_RANGE_2000DPS; //set gyro range to +/-2000dps
   
@@ -154,7 +156,7 @@
     while(1);
 
   }
-
+pc.printf("Gyro Initialized\r\n");
 }
 /**************************************************************************
 
@@ -242,7 +244,7 @@
           eMaxNeg = 0;
           serial1.printf("Error reseted");   
         }
-        //serial1.printf("Roll: %f Grad \r\n",filter.getRoll());
+        pc.printf("Roll: %f Grad \r\n",filter.getRoll());
 
     }
     //Stop timer