Added getJointForceTorque for zmp debugging