Updated collision detection

now returns [distance, angle] in radians.