Vector calculation for fast collision detection added