From 2641e3a01d9b398a4a82cb471a41933059e86eda Mon Sep 17 00:00:00 2001 From: alanbjohnston Date: Fri, 27 Nov 2020 13:48:28 -0500 Subject: [PATCH] testing Angular Velocity --- afsk/main.c | 10 +++------- 1 file changed, 3 insertions(+), 7 deletions(-) diff --git a/afsk/main.c b/afsk/main.c index fa852714..da882833 100644 --- a/afsk/main.c +++ b/afsk/main.c @@ -1107,14 +1107,10 @@ if (payload == ON) gyroZ = atof(token); printf("gyroZ %f \n", gyroZ); } - -// xAngularVelocity = (-0.69)*(gyroX)*(gyroX) + 45.3 * (gyroX) + 2078; -// yAngularVelocity = (-0.69)*(gyroY)*(gyroY) + 45.3 * (gyroY) + 2078; -// zAngularVelocity = (-0.69)*(gyroZ)*(gyroZ) + 45.3 * (gyroZ) + 2078; - xAngularVelocity = 1 * (gyroX) + 2048; - yAngularVelocity = 1 * (gyroY) + 2048; - zAngularVelocity = 1 * (gyroZ) + 2048; +// xAngularVelocity = 1 * (gyroX) + 2048; +// yAngularVelocity = 1 * (gyroY) + 2048; +// zAngularVelocity = 1 * (gyroZ) + 2048; } encodeA(b, 0 + head_offset, batt_a_v);