سلام
آقای احمد امیری https://github.com/ahmad-amiri یه کتابخونه ی خوب با فیلتر کالمن نوشتن. من که استفاده کردم راضیم!

لینک گیت هاب => https://github.com/ahmad-amiri/PRO-IMU