add thread for drive straight, not finished