* adding DrakeJoints
* improved setSubMatrixGradient.