2/23 計器

Dependencies:   SDFileSystem mbed

Files at this revision

API Documentation at this revision

Comitter:
taurin
Date:
Thu Feb 25 09:13:46 2016 +0000
Parent:
1:5ec2409854da
Commit message:
aaaa

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
diff -r 5ec2409854da -r 5a1a638f5fe6 main.cpp
--- a/main.cpp	Wed Feb 24 10:22:59 2016 +0000
+++ b/main.cpp	Thu Feb 25 09:13:46 2016 +0000
@@ -126,7 +126,7 @@
         }
         mpu6050.MadgwickQuaternionUpdate(ax, ay, az, gx*PI/180.0f, gy*PI/180.0f, gz*PI/180.0f);
         delt_t = t.read_ms() - count;
-        if (delt_t > 500) { // update LCD once per half-second independent of read rate
+        if (delt_t > 800) { // update LCD once per half-second independent of read rate
             yaw   = atan2(2.0f * (q[1] * q[2] + q[0] * q[3]), q[0] * q[0] + q[1] * q[1] - q[2] * q[2] - q[3] * q[3]);
             pitch = -asin(2.0f * (q[1] * q[3] - q[0] * q[2]));
             roll  = atan2(2.0f * (q[0] * q[1] + q[2] * q[3]), q[0] * q[0] - q[1] * q[1] - q[2] * q[2] + q[3] * q[3]);