Improved turning

We still have to add waiting for the sensor.