An underwater active sonar system and method for measuring instrument velocity with respect to a boundary surface is disclosed. The system includes an acoustic transducer configured to transmit and receive a plurality of acoustic beams in different directions. The system also includes a processor configured to detect a boundary surface within each beam; iteratively filter received acoustic signals backscattered from the transmitted beams with an adaptive filter and associated bandwidth that is successively decreased for each iteration; and measure instrument velocity with respect to the boundary surface.