或许有需要可以试试这个库,jrowberg大佬写的,内置了卡尔曼滤波器和坐标转换,自己的代码用的就是这个,感觉还挺准的
XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX