Updated torso EOM to use new drake.
Fix to bodyKin in no-mex case.