Climber code needs to be tested

[kevinzwang]

this includes:

1. testing angle calculations without climbing
2. testing and tuning auto climb (safely)