Climb command and climber subsystem
Fixed stupidity with climbing code

Added variables to robotmap and added the climber to commandbase.
Merge pull request #8 from PYates77/master

Added climbing code and fixed robotmap and commandbase