Localization with TOA as a constrained robust stochastic least squares problem