progress on multilateration code (still serious issues with returned values)