More general tolerance implementation

Current implementations are only working for the use-cases I currently have. And also for the optimization, it will be needed to copy over majority of the code.
It would be worth to explore how to generalize the concept.