Switched to new collisionsystem (with QuadTree).

Its faster than before, but still a little slow.
The code is still a little messy. Will clean it later.