Added configuration parameters colorThreshold, toleranceDist, and toleranceAngle