Moved robot parts into subsystems and implemented a PID loop for the shooter (not tuned yet)