Remove boost test lib (use header only)
Optimize and add more tests