Implement specialized version of invert for 3x3 dense matrices.

We have used this kind of specialization in a down stream module to increase the performance of the ILU setup a bit