Adds multilateration.
Merge pull request #1 from selassid/master

Multilaterate like champs.