Greatly improved support for matrices and matrix transformations.
Add 3d Tests