FRC Team 3175 Solenoid Code Help