Compare in the unitmotion overlay the estimated positions, and see they are improved when units work their way around obstructions. Otherwise nothing happened.
Do a rejoin test to be sure
Dislike the use of the turnlength somewhat, but notice that we now explicitly use the turnlength, instead of implicitly assuming that all turnlengths are equal.