有哪个大神能帮忙弄到六自由度运动平台的经典体感算法

有哪个大神能帮忙弄到六自由度运动平台的经典体感算法，就是经典洗出滤波算法的程序代码