Added some matrix functions
Merge pull request #40 from bvssvni/master

Added some matrix functions