Finished heuristics, starting working on algorithms