Fixed testBrickKinematics. collisionDetect now turns taylorvars into double before calling forwardKin (so mex will be on). Minor fix to contactPositions for taylorvars. Added a comment line to doKinematics.
Merge branch 'andres/collision-dynamics-integration'