Algorithms optimizing the trajectory of dynamically controlled object based on integral and local criteria are synthesized. Observability measure is proposed as a decision optimization rule. It is shown that optimal trajectory control improves the accuracy of navigation solutions by INS/GNSS navigation system data using automatic dependent surveillance.