Include Tolerance in BangBang Correction

[GarrettBurroughs]

Make it so that bang bang corrections have a tolerance in which they will return no output
if(error < tolerance){
output = 0
}