More reorganization and update to readme, also added matrix multiplication