WIP
Doing a little better on the speed + tests
Adding more tests
Adding tests for heuristic
Added tests, timer