Updated all classes

- Now using const correctness to the best of my knowledge
- Matrix operations now return void, assign to argument