GPS 3D trilateration