Collision Detection Update 2

It's partially working now. Better than before atleast. It still enters
walls but only one square from the cave path.