Method and apparatus for determination of range and direction for a multiple tone phased array radar in a multipath environment

A system and method combine multiple data streams in an efficient and optimal manner, based on new techniques, to determine range, relative angle and velocity with respect to a point of reference. Embodiments of the present invention take advantage of the multiple data streams to provide improved performance when the data is contaminated with environmental and system noise. Embodiments of the present invention may be applied to data output from different target estimation systems, including radar, sonar, ultrasonic and laser systems. In addition, embodiments of the present invention may be implemented in systems with multiple tones and multiple antennas, and generally work in multipath environments.