C++ Micro Pedestrian Simulation