basic three sensor test

John requested to merge trilateration_main into main

Created by: muddy100

added three sensor trigger->echo loop in main

Merge request reports