add the drakeMatrixUtil, that should contain the HomoTransform class, and other utility functions for doing matrix gradient computation