哪种算法可以帮我抵消传感器融合数据?

时间:2014-05-24 18:02:13

标签: c# accelerometer gyroscope magnetometer

我的传感器融合数据来自GYRO-ACC-MAG硬件传感器。

它的数据(YAW-PITCH-ROLL)从-180+180-90+90

哪种算法可以帮助我将其偏移到任意位置,并且没有符号更改为减号?

我的意思是:-180+180例如导致0359。我希望0不是传感器0的位置,而是偏移到某个位置。换句话说,画一个圆圈。现在将零置于该圆上的任意位置。现在围绕它的中心点旋转该圆圈。零旋转,所以它现在处于与以前不同的位置,对吧?这就是想法。

我做了什么:

YAW + 180会导致0 to 359Pitch + 90导致0 to 179Roll + 180会导致0 to 359

1 个答案:

答案 0 :(得分:1)

如果我理解正确,你想使用模运算符:

double YAW360 =  (YAW+180)%360;

请参阅http://msdn.microsoft.com/en-us/library/0w4e0fzs.aspx

模运算符进行除法并返回除法余数

17 / 5 = 3 rest 2

因此:

17 % 5 = 2