Fixed Movement Issues and Optimized Collision Detection Iterator