Kd-Trees implemented. For testing reasons implemented a time measerment
for the collisions