Agent Prioritization for Autonomous Navigation