using desired foot yaw as input to pelvis control block
use_mex=2 bug fix
Merge pull request #304 from kuindersma/pelvis-control-update

Pelvis control update for Atlas examples