Matrix multiplication

Added a matrix multiplication function, and a type for 3x3 matrices. If
required, it is easy to add additional typedefs for more matrix sizes.