public SensorData()
{
Q = new CQuaternion();
acc = new Acc();
gyro = new Gyro();
}
//用于过滤数据突变
public Acc Acc_packet(int[] data, int count,int indexID)
{
Acc acc = new Acc();
acc.acc_1 = TwoBytes(data[10], data[11]) / 16384;
acc.acc_2 = TwoBytes(data[12], data[13]) / 16384;
acc.acc_3 = TwoBytes(data[14], data[15]) / 16384;
return acc;
}