Merging in Humanoids 2014 work

We should still move more of our examples out of `solvers/trajectoryOptimization/dev` into `examples/Atlas` (and the one that has been moved - `testRunningPlanner` - should be simplified), but all the functionality works, so I'd like to get this merged in prior to doing that. 

Agreed. Along the same lines as my comment above, I'd suggest we put this one with the others in dev for now.