DRC Drake updates

among other things includes updates to Atlas control classes to support smooth foot trajectories and heel off walking
Is this used for evaluating the cost in trajectory optimization? It could be vectorized `[h(1) h(2)   h(N)]`. But it is not urgent.