MIT assignment 3 physical simulation, Pendulum system