Added utils to decompose matrix, [not enough] tests, beginnings of caching
3d rotations, scales, and translates