Text this: Nonlinear programming-based ranging optimization for three-dimensional indoor time of arrival localization