Trajectory Optimization for Target Localization With Bearing-Only Measurement

摘要

This paper considers the problem of two-dimensional constrained trajectory optimization of a point-mass aerial robot for constant-maneuvering target localization using bearing-only measurement. A performance metric that can be utilized in trajectory optimization to maximize target observability is proposed first based on geometric conditions. One-step optimal maneuver that maximizes the observability criterion is then derived analytically for moving targets. The heading angle constraint is also incorporated in the proposed optimal maneuver derivation to support practical application. Numerical simulations with some comparisons are presented to validate the analytical findings.