Implemented IMU-slope filter for the templateMatcher