Write climb sequence

This is currently the only automatic function.  Driver pulls against the platform, pushes a button on xbox controller, then its all automatic from there. No more driver input, except to possibly add some drive input to realign if lost or abort. 