Add capability to the subsystems, including automated teleop commands and the beginnings of the autonomous commands.

https://docs.google.com/spreadsheets/d/1ooZkpY9gzfeaDdNphHbpw9bJdUzkiXeSPv-J0ntVnVw/edit#gid=0