public SensorData()
{
Q = new CQuaternion();
acc = new Acc();
gyro = new Gyro();
}
public Gyro Gyro_packet(int[] data, int count)
{
Gyro gyro = new Gyro();
gyro.gyro_1 = TwoBytes(data[16], data[17]) / 16384;
gyro.gyro_2 = TwoBytes(data[18], data[19]) / 16384;
gyro.gyro_3 = TwoBytes(data[20], data[21]) / 16384;
gyro.gyro_mag = System.Math.Sqrt(gyro.gyro_1 * gyro.gyro_1 + gyro.gyro_2 * gyro.gyro_2 + gyro.gyro_3 * gyro.gyro_3);
return gyro;
}
