fixed trilateration.py