Final Commit

Tested the methods with matrices