Add addTRId for 3 points used in trilateration