Optimized code for benchmarking.
Code optimizations.
Remove debugging code, update README.