Added CMakeLists file, got it working. Also added matrix substraction