Implemented the Pendulum system benchmark, still needs prinout function