哪个算法能帮我抵消传感器融合数据

Question

我有这个传感器融合数据来自gyroc - ac - mag -硬件传感器。

数据(YAW-PITCH-ROLL)从-180到+180或-90到+90

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

我的意思是:例如，-180到+180会导致0到359。我希望0不是传感器的0，而是偏移到某个位置。换句话说，想象一个圆。现在在圆的任意位置放一个0。现在绕着它的中心点旋转这个圆。0旋转了，所以它现在的位置和之前不同，对吧?这就是我的想法。

我做了什么:

YAW + 180通向0 to 359。Pitch + 90通向0 to 179。Roll + 180引出0 to 359

Answer 1

如果我理解正确的话，您想使用模运算符:

double YAW360 =  (YAW+180)%360;

见http://msdn.microsoft.com/en-us/library/0w4e0fzs.aspx

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

17 / 5 = 3 rest 2

因此:

17 % 5 = 2