Anyone implemented the Haversine formula in B3D?

; Ported from http://www.movable-type.co.uk/scripts/latlong.html

Function Rad# (ang#)
	Return ang * (Pi / 180.0)
End Function

Function MapDistance# (lat1#, long1#, lat2#, long2#)

	R# = 6371 ; Earth's radius in km...
	
	dLat# = Rad (lat2# - lat1#)
	dLon# = Rad (long2# - long1#)
	
	lat1 = Rad (lat1)
	lat2 = Rad (lat2)
	
	a# = Sin (dLat / 2.0) * Sin (dLat / 2.0) + Sin (dLon / 2.0) * Sin (dLon / 2.0) * Cos (lat1) * Cos (lat2)
	c# = 2.0 * ATan2 (Sqr (a), Sqr (1.0 - a))
	Return R * c

End Function

; Dundee to Edinburgh!

Print MapDistance (56.3, -2.9, 55.95, -3.34)

MouseWait
End