From eb440fbdd480af0c071b43a3bbc46c23ff40a6dd Mon Sep 17 00:00:00 2001 From: Sebastian Reichel Date: Sun, 14 Oct 2012 22:43:16 +0200 Subject: normalize gyro data --- main.vala | 5 ++--- 1 file changed, 2 insertions(+), 3 deletions(-) (limited to 'main.vala') diff --git a/main.vala b/main.vala index 98a1eea..60b1c17 100644 --- a/main.vala +++ b/main.vala @@ -27,13 +27,12 @@ Kinematics kinematics; bool loop() { try { /* get sensor data */ - int16 gx, gy, gz, ax, ay, az, mx, my, mz; + double gx, gy, gz; + int16 ax, ay, az, mx, my, mz; gyroscope.get_data(out gx, out gy, out gz); accelerometer.get_data(out ax, out ay, out az); compass.get_data(out mx, out my, out mz); - log("MainLoop", LogLevelFlags.LEVEL_DEBUG, @"sensors: GYRO: $gx $gy $gz, ACCEL: $ax $ay $az, COMPASS: $mx $my $mz"); - /* calculate kinematics (TODO: calculate time diff) */ kinematics.update(gx, gy, gz, ax, ay, az, mx, my, mz, 0.1); -- cgit v1.2.3