Add support for homogeneous 4x1 vectors

[furgalep]

We should be able to rotate and transform these.

As a minimum, we should support native types (i.e. Eigen::Vector4d), but should we also have an abstraction for homogeneous quantities?

[gehrinch]

We should implement both features.