Transfer sorting functions from SGVector to CMath
Merge pull request #2657 from sanuj/feature/SGVector_cleanup

Transfer sorting functions from SGVector to CMath