math/matrix: make operator[] non const
math/vector: make operator[] non const
math/utility: add more utilities