Climb command and Climber subsystem

more information from the robot is needed to finish these, but  this is the basic code.