Added draw_pendulum call in animation_inv_pend to draw and save the pendulum image.
Added draw_pendulum call in animation_inv_pend to draw and save the pendulum image.

ovidiualexandru/MPCToolbox,wuyou33/MPCToolbox