a algorithm to fuse imu and Encoders to position which is also precise when slipping - View it on GitHub