Code cleanup.
Code cleanup.
Code cleanup?
Code cleanup!
Merge.
Path planning fix.