Remove Turn2Track parameter.

Doesn't make sense as we always want to turn the smallest angle towards the next segment.
Refactor L2+ block.

Removed dead code.
Improved comments.
Reorganized code.