Create probabilityMap.cpp

First commit. Working code