Replace shooter angle calculation -- we don't know the zero point.

More stuff on SmartDashboard.

Created common Periodic code -- we need stuff shared with
automomousPeriodic and TeleopPeriodic.