Added more matrix code. Tested matrix code.