Mercurial > public > hwos_code

diff src/compass.c @ 214:a17359244d93

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
compass changes
author heinrichsweikamp
date Sun, 14 Dec 2014 13:56:05 +0100
parents 11d4fc797f74
children 7d9edd3b8c86
line wrap: on
line diff
--- a/src/compass.c	Sat Dec 13 11:18:56 2014 +0100
+++ b/src/compass.c	Sun Dec 14 13:56:05 2014 +0100
@@ -210,7 +210,7 @@
 
     //---- Calculate sine and cosine of roll angle Phi -----------------------
     sincos(accel_DZ_f, accel_DY_f, &sin, &cos);
-    compass_roll = itan(sin, cos) / 100;
+//    compass_roll = itan(sin, cos) / 100;
 
     //---- rotate by roll angle (-Phi) ---------------------------------------
     iBfy = imul(iBpy, cos) - imul(iBpz, sin);
@@ -219,7 +219,7 @@
 
     //---- calculate sin and cosine of pitch angle Theta ---------------------
     sincos(Gz, -accel_DX_f, &sin, &cos);     // NOTE: changed sin sign.
-    compass_pitch = itan(sin, cos) / 100;
+//    compass_pitch = itan(sin, cos) / 100;
 
     /* correct cosine if pitch not in range -90 to 90 degrees */
     if( cos < 0 ) cos = -cos;