Added climbing code and fixed robotmap and commandbase