Implement Climbing Subsystem

[KellenWatt]

Components

• 2 sets of solenoids (DoubleSolenoid)
• magnetic switch (Digital Input)

Constructor Requirements

• Ensure lower pneumatics are retracted
• Ensure upper pneumatic is extended (this will likely be inverted physically, so treat it as retracted)

Behaviour

• Lower cylinders
  • extend
  • retract
  • check if fully retracted with magnetic switch
• Upper cylinders
  • extend, if lower fully retracted
  • retract, if lower fully retracted

Toggling each solenoid is an option (see DoubleSolenoid::Toggle), but it might not be useful feature. Add it if you like, but it's not a requirement.