来自 Madgwick AHRS 的结果值小于 -180° 的问题

Problem in result value lesser than -180° from Madgwick AHRS

我使用 Madgwick AHRS algorithmgyroscopemagnetometer 实现了获得方向估计的代码。

我想效果不错。但是,在某些范围的数据中,-180°以下的结果值有一个问题:值是 "lifted up." 我找不到合适的词来表达这个,所以我附上了下图。我查看了代码,但没有得到任何解决此问题的线索。我遵循了存储库 here(Matlab code zip file) 给出的示例代码。我想知道如何解决这个问题。提前致谢!

非常感谢@AnderBiguri 和@Daniel 的帮助!抱歉我回复晚了。

unwrap 函数运行良好。这给了我内心的平静。

unwrap之前:

unwrap之后: