Added basic turning and removed PID control