Code Cleanup and Documentation

[markpete]

There are unused imports, commented-out code blocks (dead code), and a lack of Javadoc on public methods.

Action Items:
Run a linter/formatter to remove unused imports and format code.
Remove commented-out code that is no longer needed.
Add Javadoc to public methods in SuperStructure and Subsystems to explain their purpose and parameters.