Adding inverse and multiply to Matrix4d. Will start writing tests after I finish.