Fixes for cornering. Added GUI.
Incorrect variable name.
Optional debug information. Path following jitter.