Added pendulum stabilizing controller