Added improved differential steering algorithm