Many additional comments in the code.
Simulated robot added for testing portions.