eval() for performance.
Constants in all caps.
More geometry util methods. Also moved normalizeVec to drakeGradientUtil
Added mex/matlab comparison test. Fixed transpose bug. Moved testNormalizeVec.
added dquat2rotmat.
drotmat2rpy, drotmat2quat.
* adding DrakeJoints
* improved setSubMatrixGradient.