Started work on matrix library
A little more work on matrix library