Matrix stack implementation, many more matrix funcs