Diff: main.cpp

Revision:

6:40b1004cfbe7

Parent:

4:6db9395e43d8

--- a/main.cpp	Thu Mar 26 13:42:01 2020 +0000
+++ b/main.cpp	Sun Mar 29 00:07:59 2020 +0000
@@ -131,7 +131,7 @@
     while(1) {
         // MICHI
         //---------------------------------------------------------
-        aktuell = leds.show_Aktuell(aktuell,sensor);
+        //aktuell = leds.show_Aktuell(aktuell,sensor);
         //wait(1);
         //---------------------------------------------------------
         
@@ -228,6 +228,15 @@
             roll  *= 180.0f / PI;
 
             pc.printf("Yaw, Pitch, Roll: %f %f %f\n\r", yaw, pitch, roll);
+            
+            //*****************************************************************
+            // Übung 1
+            
+            aktuell = leds.Wasserwaage(pitch,aktuell);
+            
+            //*****************************************************************
+            
+            
             //pc.printf("average rate = %f\n\r", (float) sumCount/sum);
 //    sprintf(buffer, "YPR: %f %f %f", yaw, pitch, roll);
 //    lcd.printString(buffer, 0, 4);