Add minor utilities

Reorganized to put main functions at bottom
Added operator overloading for Vec
Merge in reorganization from movement branch