Geo: Fixed rounding/casting errors in point normalization

Also added unit tests for GeoUtils
Is it commented out on purpose?