Add sort and bsearch
const correctness
Add vector search and sort tests
Correct index function and add index vector