Added turning in autonomous mode and removed contour connection