Moving in a Crowd: Safe and Efficient Navigation among Heterogeneous Agents.