Support NLLS multilateration with more than four beacons.

Small PR.  Support NLLS multilateration with more than four beacons.