Add javadoc comments

Added comments to main Robot methods. Removed redundant initialisations
and unused methods.