Climb finished

Lock on bar and solenoid should be a toggle
move each arm with the thumbsticks
Make sure and test toggleButton(); in froboClimb