Getting it working

Small issues with turning, and sensor reading times.