Added heuristic, updated Map class
Optimized output, refactored code
Updated docs, refactored core