Implemented upper-body gravity compensation
(Added new coordinateActuators: 3-dof for lumbar + 7-dof per arm,
set their desired qdd to zero, used EOM to generate ffwd torques for grav. comp.
quite similar result is still generated for lower-body torques and contact forces).