Intiial test of a general multilateration solution.

Currently includes a undocumented standalone program at the end of
multilateration.cpp which tries out the multilateration implementation.