Trilateration equations