Multilateration with 4 ref nodes