我的传感器融合数据来自GYRO-ACC-MAG硬件传感器。
它的数据(YAW-PITCH-ROLL)从-180
到+180
或-90
到+90
哪种算法可以帮助我将其偏移到任意位置,并且没有符号更改为减号?
我的意思是:-180
到+180
例如导致0
到359
。我希望0
不是传感器0
的位置,而是偏移到某个位置。换句话说,画一个圆圈。现在将零置于该圆上的任意位置。现在围绕它的中心点旋转该圆圈。零旋转,所以它现在处于与以前不同的位置,对吧?这就是想法。
我做了什么:
YAW + 180
会导致0 to 359
。 Pitch + 90
导致0 to 179
。 Roll + 180
会导致0 to 359
。
答案 0 :(得分:1)
如果我理解正确,你想使用模运算符:
double YAW360 = (YAW+180)%360;
请参阅http://msdn.microsoft.com/en-us/library/0w4e0fzs.aspx
模运算符进行除法并返回除法余数:
17 / 5 = 3 rest 2
因此:
17 % 5 = 2