New turnAngle2 function, still working on loop