Some fixes for the SimpleMode.
Optimize line segment order a bit so it favors going more in a straight line.