Add consistent methods to subsystems for robot init, mode change, and periodic.
Get some telemetry in.
Add methods for getting the vision and telemetry tables.