Implementing more robust equality check.

Because of rounding in floating point operations, direct equality
check is not reliable. This implements robust method evaluating
distance of two numbers and comparing it to small enough constant.

Change-Id: I2d71bd0ad6524c015676f0c57c6070eede968709