Added front threshold adjustment that uses front angles to determine a good threshold for turning instead of just taking the average