Added logic for collection subsystem.
Added logic for the drivetrain subsystem.