Fixed the collision resolution code to properly resolve collisions. No more clumps of units.
Added an FPS counter and more agents to see how far I could push it.