Click link to show video of  inverted pendulum moving with sinusoidal position.  Implement something similar.  Inverted pendulum