Add simple matrix class