Got rid of the const modifier on float function parameters
Added more Matrix methods and removed const modifier on float parameters