code improvement heatmap.cpp
tried to implement statemachine but pathfinding fails :'(
Merge branch 'master' of https://github.com/Streamstormer/PanicSim