Refactored utils into multiple files and a folder
Generic Matrix class basis (not fully implemented), updated some tests and other related files