Changed float precision to double precision.
Fixed bug on cache contacts. Needs to be cleaned on each detection