From a0bd460f7f901d48d111511d9e7c2d92aaac0fa2 Mon Sep 17 00:00:00 2001 From: Sebastian Reichel Date: Tue, 30 Oct 2012 11:19:10 +0100 Subject: update rate --- sensors/gyroscope/itg3200.vala | 8 ++++++-- 1 file changed, 6 insertions(+), 2 deletions(-) (limited to 'sensors/gyroscope/itg3200.vala') diff --git a/sensors/gyroscope/itg3200.vala b/sensors/gyroscope/itg3200.vala index e616848..bc99769 100644 --- a/sensors/gyroscope/itg3200.vala +++ b/sensors/gyroscope/itg3200.vala @@ -14,7 +14,7 @@ */ public class ITG3200 : I2CDevice, Gyroscope { - public int[] rate { get; set; } + public double[] rate { get; set; } private int[] zero = new int[3]; /* ITG3200 14.375 LSBs per °/sec in radians */ @@ -37,7 +37,7 @@ public class ITG3200 : I2CDevice, Gyroscope { } public void init(KeyFile cfg) throws KeyFileError, I2CError { - rate = new int[3]; + rate = new double[3]; var adapter = cfg.get_uint64("ITG3200", "i2c-adapter"); var address = cfg.get_uint64("ITG3200", "i2c-address"); @@ -88,6 +88,10 @@ public class ITG3200 : I2CDevice, Gyroscope { x = ((int16) get_big_word(0x1d)-zero[AXIS.X]) / scale; y = ((int16) get_big_word(0x1f)-zero[AXIS.Y]) / scale; z = ((int16) get_big_word(0x21)-zero[AXIS.Z]) / scale; + + rate[AXIS.X] = radians(x); + rate[AXIS.Y] = radians(y); + rate[AXIS.Z] = radians(z); } } -- cgit v1.2.3