New trilateration algorithm to better handle low precision distances.
Merge remote-tracking branch 'origin/master'