Delays are now tunable via #defines, and are much reduced. Some old (wrong) code removed. A few more hand-tuned items.
Major changes to the sonar side functions (getMisalignment, getSideWallDistance) in order to make them more reliable.
Parameter changes only.
Added some needed distances between nodes 1 and 4.
Primarily a comments change.