A first try to efficiently implementing control search space. Most important: re-use of previous calculated states. In turn simulate and MPC.