Filled out subsystem methods; having errors with OI, so did not include
those files in this commit
Merge branch 'master' of git@github.com:CRRobotics/Robots.git