Observability Based Optimal Path Planning For Multi-Agent Systems To Aid In Relative Pose Estimation