https://github.com/aleksandarhaber/simulation-of-state-space-models-of-dynamical-systems-in-cpp--eigen-matrix-library-tutorial