Turn up speed on turn and straight

skip search direction
go straight to start

changed filter gain