Fixed int32 to int
Added function prototype for distance calculation
Added getRangeToWaypoint
Renamed getRangeToWaypoint -> getRangeToPosition
Renamed getRangeToWaypoint -> getRangeToPosition