Feature/add to vector

Added to_vector to math lib (and manual) with tests.