Add minor utilities

Reorganized to put main functions at bottom
Added operator overloading for Vec