Made the stepTowardsPoint() method much more robust and smooth by using vectors.