My code for FRC 3941's Aerial Assist robot's pick up subsystem.