Adding a test for the simple pendulum energy