Drake quat util updates

* drakeQuatUtil --> drakeGeometryUtil
* made drakeQuatUtil functions return by value
* a few obvious speedups (e.g. using templatized Eigen block methods) while I'm at it