Add mechanum tolerance