Calculate distance to Goal target