diff options
author | Sebastian Reichel <sre@ring0.de> | 2012-10-14 22:43:16 +0200 |
---|---|---|
committer | Sebastian Reichel <sre@ring0.de> | 2012-10-14 22:43:16 +0200 |
commit | eb440fbdd480af0c071b43a3bbc46c23ff40a6dd (patch) | |
tree | 95522b064fdb9f133eba0ddcb588af29bfda5a1a /main.vala | |
parent | 25ac6a9d3096ec740db3102a6a2ca33b20d6b1c5 (diff) | |
download | microcopterd-eb440fbdd480af0c071b43a3bbc46c23ff40a6dd.tar.bz2 |
normalize gyro data
Diffstat (limited to 'main.vala')
-rw-r--r-- | main.vala | 5 |
1 files changed, 2 insertions, 3 deletions
@@ -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); |