add trilateration for position computing
add trilateration for position computing
update gui, fix test_full
update test structure but fails
merge with old unit_tests branch locally on vuhai computer
rebase from unit tests branch
tracing for test_full
set drone in test_full mode
test_full tracing