Some discrete map implementation. Next will be convolution and update with data from sensors + add physicalRobot class