Fixed subtle bug in dHomogTransInv.
Extracted out testUtil.h
Added Matlab comparison for geometry gradient utils. Caught a bug this way.