Implement unit tests for the function of trilateration on a 2D plan