Update collisiondetect2.py

Calculates heading and turns towards it