Rewrite C++ code

[fding]

Right now, the C++ code might allow for memory leaks. In particular, a new System object is created upon every call of simulate(). We should investigate what happens to the memory that is allocated, and whether or not to change it so that C++ also only has a simulate function.