DRC Drake updates

among other things includes updates to Atlas control classes to support smooth foot trajectories and heel off walking
Duplication of code, @avalenzu