Hand control demo and updates

Adds demo example for atlas balancing with a robotiq hand attached. Updated from last pull request to include fixes I needed to get the full simul with hand working over on the DRC branch. Next up will be a rebase of that onto this...