fixed some bugs
ToDo:
- integrating timer class
- implementing 3d-grid

bugs:
- SolveKDTreeCollision() leads to unintended visual effects, maybe because of fps drops caused by BuildKdTree()