Geo: Fixed rounding/casting errors in point normalization

Also added unit tests for GeoUtils