Added AgentType, and some smaller functions regarding collisions between bodies in world