Added turnTo function, modified some variables