Optimization-Based Robust Localization of JADE Agents in Indoor Environments